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parameters.  This  thesis  investigates  the  required  feedbacks  for  robust  automatic  depth  control 
at  periscope  depth,  and  thus  indirectly  determines  the  additional  parameters  desired  for  an 
integrated  display. 

A  model  of  vertical  plane  submanne  dynamics  is  coupled  with  first  and  second  order 
wave  force  solutions  for  a  particular  submarine  hull  form.  Sliding  mode  control  and  several 
schemes  of  state  feedback  are  used  for  automatic  control.  Head  and  beam  seas  at  sea  states 
three  and  four  are  investigated.  The  automatic  control  effectiveness  provides  insight  into  the 
indications  used  by  the  ship's  control  party  in  operations  at  periscope  depth.  One  possible 
display  system  is  proposed,  with  several  additional  enhancements  to  improve  ship's  safety, 
reduce  operator  fatigue,  and  enable  accurate  reconstruction  of  the  events  leading  to  a  loss  of 
depth  control. 
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I.  INTRODUCTION 

A.  GENERAL 

The  need  for  attack  submarines  to  operate  at  penscope  depth  has  been  increased  by 
integration  with  earner  battle  groups,  operations  in  the  shallow  littoral,  and  contributions  to 
joint  surveillance. 

Operating  at  periscope  depth  beneath  a  seaway,  a  submarine  is  in  an  unstable 
condition.  As  the  free  surface  is  approached,  the  seaway  forces  increase,  trying  to  pull  the 
submanne  to  the  surface.  To  counter  these  forces,  the  ship's  ballast  is  changed  and  control 
surfaces  are  used.  Because  of  the  seaway's  stochastic  nature,  manual  operation  for  long  periods 
at  periscope  depth  taxes  the  ship's  control  party. 

Operators  must  remain  aware  of  the  environmental  conditions.  If  the  sea  becomes 
quiescent,  the  submarine  will  sink  out.  If  the  sea  suction  forces  are  greater  than  the  ballast  and 
planes  authority,  the  submarine  will  broach  the  free  surface  increasing  detection  risk  by  several 
orders  of  magnitude.  Other  events,  like  temperature  or  salinity  changes,  can  also  have  major 
effects  on  reliable  depth  keeping.  Contributing  to  the  environmental  issues,  the  need  to  use 
minimum  speed  for  a  given  sea  state  to  control  the  detectable  mast  feather  reduces  the 
available  planes  authority,  and  increases  the  difficulty  of  depth  control. 

However,  the  current  submarine  force  is  not  optimized  for  these  operations.  One 
inexpensive  area  for  improvement  is  the  display  system  for  the  ship's  control  party.  Modern 
digital  display  systems  offer  ergonomic  improvements  over  current  gauges  and  readouts. 

Given  a  requirement  to  conduct  submarine  ship  control  manually,  a  fundamental 
question  is  that  of  how  to  display  the  state  of  the  ship  to  the  operators.  Aside  from  the 
obvious  indications  like  ship's  pitch  angle,  depth,  and  control  surface  positions  what  else  would 
be  useful?  Candidates  include  the  net  force  acting  on  the  ship,  accelerations,  and  various  time 
averaged  values.  Implied  in  this  is  that  a  nontraditional  means  of  display  will  be  used  to  show 
these  parameters,  so  that  the  operators  will  not  have  to  rely  on  a  number  of  gauges  or  meters, 
with  averaging  of  results  only  available  only  by  the  calibrated  eye. 

An  intelligent  assistant  to  the  ship's  control  party  would  show  items  of  current 
concern,  and  issue  alerts  based  on  an  operator  programmable  doctrine.  Issues  like  mast 
exposure,  ship's  relationship  to  the  bottom,  and  trim  state  could  be  shown  in  an  intuitive, 
logical  manner. 


Current  evolutions  and  other  items  relating  to  the  tactical  employment  could  be  included  as 
required. 

B.  AIM  OF  THIS  STUDY 

Although  the  ship's  control  party  currently  relies  on  a  small  number  of  indications,  the 
ability  to  sense  "by  the  seat  of  the  pants"  cannot  be  discounted.  This  thesis  investigates 
required  feedbacks  for  robust  automatic  depth  control  at  penscope  depth,  and  thus  indirecdy 
evaluates  the  additional  indications  to  be  added  to  an  integrated  display. 

This  approach  assumes  that  the  best  ship's  control  parties  already  use  system  states  for 
control  which  are  not  explicitly  displayed. 

C.  THESIS  OUTLINE 

Chapter  II  contains  the  development  of  the  deeply  submerged  submarine  dynamics 
model.  Chapter  III  gives  the  development  and  source  of  the  wave  forces  used  to  simulate 
operations  at  periscope  depth.  In  Chapter  IV,  optimization  studies  are  performed  for  nine 
different  cases  of  state  feedback  control.  This  gives  a  feeling  for  the  quality  of  depth  control 
achievable  by  the  use  of  different  levels  of  sensors.  Chapter  V  explores  the  use  of  sliding 
mode  control  for  periscope  depth  operations.  In  Chapter  VI,  current  ships  control  technology 
is  reviewed  and  an  integrated  display  is  proposed.  Conclusions  and  recommendations  are 
given  in  Chapter  VII. 


II.         SUBMARINE  DYNAMICS  MODEL 

A.  INTRODUCTION 

When  a  submarine  is  deeply  submerged,  many  of  its  maneuvering  characteristics  can 
be  determined  from  application  of  Morison's  equation  to  model  test  data.  A  series  of  trials, 
often  done  with  a  planar  motion  mechanism  (PMM),  give  the  damping  and  inertia  coefficients 
for  small  maneuvers  in  each  of  the  six  degrees  of  freedom.  This  method  is  not  without  limits. 
For  trials  done  in  the  horizontal  and  vertical  planes  only,  nonlinear  cross  coupling  effects  are 
ignored.  The  hydrodynamic  coefficients  work  poorly  for  prediction  of  high  speed  maneuvers 
and  control  surface  casualties.  Here  the  large  crossflow  velocities,  vortex  hull  interaction,  and 
flow  separanon  all  have  effects  which  are  not  predicted  by  the  hydrodynamic  coefficients.  It  is 
possible,  however,  to  include  some  of  these  effects  as  additional  nonlinear  terms. 

As  the  submarine  approaches  the  free  surface,  several  complexities  are  introduced  into 
the  hydrodynamic  coefficient  approach.  First,  the  inertia  terms  change  as  an  acceleration  will 
no  longer  act  upon  an  effectively  infinite  region.  Second,  an  inviscid  form  of  damping  exists 
near  the  free  surface.  This  comes  about  from  the  generation  of  waves  by  the  body,  and 
depends  on  the  body  depth  and  character  of  motion.  Finally,  the  interaction  between  the 
incident  waves  and  the  submarine  introduces  added  forces  and  moments.  These  effects 
combine  to  make  designing  for  periscope  depth  vexing  for  engineers  and  operating  at 
periscope  depth  an  art  for  the  ship's  crew. 

The  approach  in  this  thesis  will  be  to  first  establish  a  dynamics  model  appropriate  for  a 
deeply  submerged  submarine  at  low  to  moderate  speeds.  The  forces  and  moments  resulting 
from  the  seaway  will  then  be  superimposed  on  this  model  to  provide  a  reasonable 
approximation  to  the  submarine  motion  beneath  waves. 

B.  DEEPLY  SUBMERGED  EQUATIONS  OF  MOTION 

1.  Definition  of  coordinate  system  and  states 

The  coordinate  system  defined  in  Figure  1  will  be  used.  The  origin  of  the  global 
coordinate  system  is  fixed  at  the  ocean  surface.  The  ^  axis  is  positive  downward,  towards  the 
ocean  bottom.  The  xaxis  is  positive  in  the  direction  of  intended  submanne  motion.  The  body 
fixed  coordinates  are  rotated  from  the  global  coordinates  by  the  angle  6  .  Body  fixed  velocities 


w  (heave)  ,  u  (surge),  and  q  (pitch)  are  shown.  The  control  surface  deflections,  5h  (bow  planes) 
and  <5V  (stern  planes)  are  also  defined. 


Figure  1 .  Coordinate  System  Definition 


2.  Hydrodynamic  coefficients  review 

For  a  deeply  submerged  submarine,  small  motions  can  be  analyzed  using  the  concept 
of  hydrodynamic  coefficients.    These  represent  a  Taylor  series  expansion  of  the  functional 
relationship  between  body  movements  and  the  resulting  fluid  forces.  For  example,  given  the 
deeply  submerged  body  in  Figure  2  undergoing  pure  heave,  resulting  body  forces  can  be 
expressed  in  the  following  manner: 


Figure  2.  Submerged  body  in  pure  heave 


M  =  Mvuw+  M  i  iw|w|+  M  .  w 


Z  =  Zlvw  +  ZH,|,H'|w)  +  Zvv, 


w 


(1) 

(2) 


This  method  is  extended  to  the  six  degrees  of  freedom  of  the  body,  and  done  for 
velocity  and  acceleration  components  of  the  movement.  This  includes  representations  of 
added  mass,  viscous  drag,  and  square  law  drag. 

3.  Vertical  plane  equations  of  motion 

By  using  this  system  of  notation,  and  applying  Newton's  second  law  to  the  body  fixed 
coordinates,  and  transforming  to  global  coordinates,  the  equations  of  pitch  and  heave  may  be 
obtained  in  the  vertical  plane.  The  general  case  is  quite  complex,  having  centers  of  mass  and 
buoyancy  that  are  separate  from  each  other  and  the  coordinate  system  origin.  This,  along  with 
cross  coupled  hydrodynamic  coefficients,  results  in  a  nonlinear,  coupled  set  of  differential 
equations. 

These  equations  of  pitch  and  heave  may  be  simplified  considerably  by  several 
reasonable  assumptions.  Assuming  that  the  submanne  motion  is  constrained  to  the  vertical 
plane,  the  equations  of  motion  for  heave  and  pitch  are  (Smith,  Crane,  and  Summey  (1978)): 


m[w-uq-xGq-zGq   ]  = 


(3) 


Z4q+Z^w  +  Zquq  +  Zww 

+  u2(Z55h+Z8S) 


Iyq-m[xG(w-uq)-zG(u  +  wq)]  = 


(4) 


M  q+  M u,w+  M  uq  +  M wuw 
+  u2{MSh5h  +  M58s) 
-(xGmg-xBB)cos(6) 
-(zGmg-zBB)sin(0) 


It  is  apparent  that  Equations  (3)  and  (4)  are  nonlinear,  coupled  differential  equations  in 
w  and  q  and  u.  To  reduce  this  coupling,  terms  involving  the  derivatives  of  w  and  q  can  be 
collected,  resulting  in  a  mass  matrix. 


M  = 


m-Z„ 


-Z, 


The  mass  matrix  can  be  readily  inverted: 


M~]  = 


-A/,,     r-M, 


ly~Mk  Zq 

M ,.,         m-Z^ 


(5) 


(6) 


(/n-Z^X/.-MJ-Z.A/ 


q  '  '  w 


By  applying  Equation  (6),  the  cross  coupling  of  terms  in  vv  and  q  can  be  removed 
from  Equations  (3)  and  (4).  To  allow  the  introduction  of  external  forces  and  moments,  the 
system  was  augmented  by  force  and  moment  disturbances  acting  at  the  origin  of  the  body 
fixed  coordinates.  They  were  multiplied  by  the  cosine  of  the  pitch  angle  for  conversion  to  the 
body  fixed  coordinate  system.  These  disturbances  can  be  used  to  input  external  effects,  such 
as  changes  in  trim  and  wave  forces.  By  further  assuming  that  the  center  of  buoyancy  is  at  the 
body  fixed  coordinate  system  origin,  the  center  of  mass  is  direcdy  below,  and  that  the  forward 
speed  u  is  constant,  the  equations  of  motion  can  be  reduced  to  the  following: 


w  -  auuw  +  anuq  +  a13  sin(#)  +  buu2 8h  +b]2u28s  +  Fd  cos(O)  +  euq2  +enqw  (J) 

q  =  a2]uw  +  a22uq  +  a23  sir\(6)  +  b2]u  Sh  +b22u28s  +  M d  cos(0)  +  e2]q~  +  e21qw  (°) 

6  =  q  (9) 

z  =  wcos(0)-/<sin(0)  (10) 

x  =  ws'\n(d)  +  ucos(9)  (11) 


where: 


a,,  = 


ZH(/t-A/g)  +  Z,MH 
(m-Zj(I^-Mtl)-ZqMv 


On  = 


(Z,+m)(7,  -M^  +  ZHMH 
(m-ZJ(I^-Mq)-ZM„ 


MwZw+(m-Zw)Mw 
°2]~  {m-Zw)U,-Mq)-ZqMw 


a„  = 


a«  =■ 


a-n  = 


&„  = 


&„  = 


MK(Z,+/n)  +  (m-Zw)M, 
(m-ZJ(/v-M.)-Z4M, 

Z^Gm£ 

(w-Zj(/,-M(/)-ZvMv, 

(m-ZJ(/v-M?)-Z?A/H 

(m-ZK)(I^-M.)-ZqMtt 
MHZ4  +  M4(m-ZH) 


21      (m-Zw)(/v-A^)-Z^ 


&u  = 


(7Y-A^)Z,t+Z,A^ 
(m-Z^X/.-M^-Z^M,; 

M*ZSs  +  MSt(m-Z*) 

b»  =  (m-ZK)(I^-Mq)-ZqMy 

iK-Mq)zcm 

e"      (ffl-ZJ(/v-MJ-ZM, 


e„  = 


Z  z,-m 


(m-Zj(I^-Mq)-ZqM„ 


w     O 

2'~(m-Z.)(/v-M^)-Z^M, 


t  -i  i    — 


e-n  = 


(m-  ZK)zcm 
(m-Zw)(Iy-Mq)-ZM„ 


Equations  (7)  through  (1 1)  are  the  governing  equations  of  motion  for  this  thesis.  It  is 
of  note  that  the  disturbance  force  and  moment  terms  represent  accelerations  due  to  the 
disturbances.  To  provide  ease  of  use,  the  equations  of  motion  were  implemented  in  the 
SIMULINK®  model  shown  in  Figure  3.    This  building  block  approach  was  very  effective  for 
conducting  studies  on  the  effectiveness  of  different  types  of  controllers. 
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Figure  3.  SIMULINK®  model  of  vertical  plane  submarine  dynamics 

For  control  design,  it  is  convenient  to  use  a  linear  state  space  representation  of  the 
system.  This  allows  the  use  of  a  variety  of  controller  design  tools  including  pole  placement  and 
linear  quadratic  regulator  algorithms.  Equations  (7)  through  (1 1)  can  be  linearized  about  a  level 
flight  condition.  This  results  in  the  linear  state  space  representation: 


w  =  auuw  +  a]2uq  +  a]^6  +  buu  ^,+buu  8S+Fd 

q  -  a2luw  +  a22uq  +  a2?l6  +  b2]u  5h  +b22^~5s  +  M d 

6  =  q 

Z  =  w-  u6 

x  =  wQ  +  u 


(12) 

(13) 

(14) 

05) 
(16) 


Equations  (12)  through  (15)  can  be  rewritten  in  matrix  form.  This  form  of  the  linear 
submarine  vertical  plane  dynamics  equations  will  be  used  for  controller  design.  For  controller 
design,  Equation  (1 6)  was  excluded  from  the  matrix  form.  Because  of  the  constant  forward 
speed  u  assumption,  there  was  no  direct  means  of  control  for  x. 
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C.  EXTENSION  TO  VERTICAL  PLANE  PATHKEEPING 

Equations  (7)  through  (10)  and  the  corresponding  SIMULINK®  model  are  linearized 
around  a  constant  commanded  depth,  or  level  flight.  They  can  be  extended  to  a  two 
dimensional  pathkeeping  simulation  by  a  coordinate  transformation.  After  coordinate  rotation 
by  an  angle  (5  (positive  in  the  same  direction  as0),  the  resulting  system  is: 


w  =  aliuw  +  al2uq  +  a'nsm(0')  +  b]u25+  Fd 


q  —  a2]uw  +  a12uq  +  a'2i  s\x\{6')  +  b2u~5+  Ma 

8'  =  q 

Z  =  wcos(Q')  -  Msin(0') 

x  =  wsin(6>')  +  ucos(d') 


(18) 
(19) 
(20) 

(21) 
(22) 


where: 


x'=  -zs\n(P)  +  jtcos(/3) 
Z  =  zcos(/3)  +  .rsin(/3) 

fl13  =a]3cos(/J) 

a23   =  a2}  cos(/J) 


(23) 
(24) 
(25) 
(26) 

(27) 


F,'  =  Fd+a^cos(e')sm(P)  (28) 

Md   =  Md+ancos(d')sin(p)  (29) 


If  the  expected  angular  deviation  from  the  planned  path  is  small,  Equations  (28)  and 
(29)  can  be  simplified  by  assuming  that  cos(O')  is  equal  to  one.  Then  the  rotated  equation  set, 
Equations  (18)  through  (22),  is  identical  in  form  to  Equations  (7)  through  (11). 

Equations  (23)  through  (29)  allow  any  vertical  plane  path  consisting  of  a  series  of 
straight  line  segments  to  be  simulated  one  segment  at  a  time. 

D.         THE  DARPA  SUBOFF 

1.  Background 

For  the  purpose  of  this  work,  it  was  desired  to  have  a  vertical  plane  model  of 
submarine  dynamics  which  would  give  a  similar  response  to  a  modern  fast  attack  nuclear 
submarine  (SSN).  Several  sets  of  unclassified  hydrodynamic  coefficients  were  available,  these 
being  for  the  swimmer  delivery  vehicle  (SDV)  detailed  in  Smith,  Crane,  and  Summey  (1978) 
and  for  the  DARPA  SUBOFF  model  detailed  in  Roddy  (1990). 

The  SDV  had  a  very  complete  set  of  hydrodynamic  coefficients  which  have  been  used 
in  a  large  number  of  Autonomous  Underwater  Vehicle  (AUV)  research  projects.  Among  these 
is  the  Naval  Postgraduate  School  (NPS)  AUV  sliding  mode  controller,  Hawkinson  (1990). 
Despite  these  advantages,  the  SDV  hydrodynamic  coefficients  were  not  used  because  the  wing 
like  hull  of  the  SDV  bore  little  resemblance  to  an  axisymetric  submarine  hull. 

The  SUBOFF  hydrodynamic  coefficients  detailed  in  Roddy  (1990)  lacked  some  of  the 
cross  coupling  coefficients.  The  documentation  also  lacked  details  on  the  models  metacentric 
height.  Because  the  SUBOFF  represented  a  submarine  hull  form  and  most  of  the  vertical 
plane  coefficients  and  parameters  were  available,  it  was  chosen  as  the  model  for  this  thesis. 

2.  SUBOFF  known  parameters  and  coefficients 

The  SUBOFF  was  developed  to  allow  comparison  between  flow  field  predictions  and 
model  test  data  (Roddy,  1990).  The  available  coefficients  were  based  on  planar  motion 
mechanism  tests  conducted  on  the  model. 
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Because  the  aim  of  the  study  was  to  examine  full  scale  submarine  motions,  the  model 
and  its  hydrodynanuc  coefficients  were  scaled  to  a  length  of  300  feet.  After  scaling,  several 
parameters  had  to  be  modified  or  assumed  to  give  control  and  response  comparable  to  a 
modern  fast  attack  submanne.    The  force  coefficients  of  the  stern  planes  was  doubled  to 
provide  a  more  realistic  level  force.  Bow  planes  were  assumed  to  have  one  half  the  force  and 
one  quarter  the  moment  authority  of  the  stern  planes.  Finally,  a  metacentric  height  of  one  foot 
was  assumed,  as  it  provided  a  realistic  point  of  stern  planes  reversal.  The  resulting  parameters 
are  shown  in  Table  1 . 
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Parameter 

SUBOFF  Model 

Scaled  /  Modified  Result 

Length  (Feet) 

14.2917 

300 

Displacement  (tons) 

0.7704 

7,7145 

Maximum  Diameter  (Feet) 

1.667 

35 

Metacentric  Height  (Feet) 

Not  Provided 

1 

XG 

0.00975 

0 

ZG 

Not  Provided 

1 

XB 

-0.006669 

0 

ZB 

Not  Provided 

0 

Zk 

-0.005603 

-0.011206 

M'Si 

-0.002409 

-0.004818 

Zk 

Not  Provided 

-0.005603 

Mk 

Not  Provided 

0.0012045 

Table  1 .  SUBOFF  Assumed  and  modified  parameters 

E.  CONCLUDING  REMARKS 

A  simplified  model  of  submarine  vertical  plane  dynamics  was  derived.  The  coefficients 
for  use  in  this  model  were  obtained  from  the  DARPA  SUBOFF  model,  which  is  a 
representative  axisymetric  submarine  hull  form.  The  simplified  nonlinear  equations  of  motion 
were  incorporated  in  a  SIMULJNK®  model  to  allow  easy  integration  with  wave  force  models 
and  different  controllers. 
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Figure  4.  DARPA  SUBOFF  model,  Roddy  (1990) 


13 


14 


III.       WAVE  FORCE  MODELING 

A.  INTRODUCTION 

As  a  submarine  operates  near  the  free  surface,  it  encounters  complex  forces  which  may 
cause  unsatisfactory  or  unstable  depth  control.  The  lift  and  moment  from  incident  waves 
increase  in  an  exponential  manner  as  the  surface  is  approached.  To  maintain  a  desired  depth, 
the  ship's  ballast  is  adjusted  to  counteract  steady  forces.  Control  surfaces  are  used  to  counter 
dynamic  changes.  A  small  depth  excursion  or  change  in  forces  can  overwhelm  the  planes  and 
cause  a  loss  of  depth  control.  The  consequences  range  from  losing  radio  reception  to 
compromising  the  ship's  mission. 

The  effects  of  incident  waves  on  a  submerged  body  can  be  divided  up  in  several 
categories.  The  largest,  the  first  order  forces  act  at  the  incident  wave  frequency.  These  forces 
move  the  submanne,  but  usually  result  in  oscillations  about  a  mean  state.  Second  order  forces, 
which  are  the  result  of  wave  diffraction  and  wave  interaction,  have  several  different  frequency 
components. 

Wave  diffraction  of  a  single  frequency  wave  results  in  a  steady  force  and  a  varying 
force  at  twice  the  wave  frequency.  The  double  frequency  force  is  typically  neglected,  as  the 
large  inertia  of  the  submarine  effectively  filters  it.    Interactions  of  waves  at  different 
frequencies  also  results  in  forces.  These  consist  of  a  component  acting  at  the  sum  of  the  wave 
frequencies  and  a  component  acting  at  the  difference  of  the  wave  frequencies.  The  sum 
frequency  force  is  typically  neglected,  as  it  is  also  filtered  by  submarine's  inertia.  The  difference 
frequency  component  results  in  a  slowly  varying  force  on  the  submarine. 

The  slowly  varying  forces  are  the  principle  cause  of  difficult  periscope  depth  control 
(Ni,  Zhang,  and  Dai,  1994).  They  are  compensated  for  using  control  surfaces  and  occasional 
adjustments  of  trim. 

During  the  design  phase,  engineering  decisions  are  made  which  will  determine  the 
ship's  ability  to  remain  at  periscope  depth.  Of  these,  the  most  critical  are  the  height  of  the  sail 
and  control  surface  sizes.   Ever}'  foot  added  to  the  sail  gives  a  deeper  penscope  depth.  Larger 
planes  improve  the  operator's  ability  to  compensate  for  changes  in  suction  forces.  However, 
these  improvements  are  not  without  cost.  The  sail  and  other  appendages  are  a  large  fraction  of 
the  total  drag,  and  can  restrict  the  ship's  top  speed.  Larger  movable  control  surfaces  can 
adversely  affect  the  high  speed  casualty  recoverability  (Jackson,  1992,  p.  15-9). 
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The  goal  of  this  thesis  is  not  to  provide  new  tools  for  the  designer,  but  rather  new- 
means  to  enhance  control  for  the  operators  of  current  submarines.  Due  to  this  focus, 
simplified  means  of  modeling  the  wave  forces  for  a  few  specific  cases  will  be  used. 

B .  REVIEW  OF  LINEAR  DEEP  WATER  WAVES 

The  pertinent  features  of  linear  deep  water  waves  will  be  reviewed  to  provide 
background  for  the  following  sections.  The  coordinate  system  used  for  the  examples  is  shown 
in  Figure  5.  For  the  examples  in  this  section,  it  will  be  assumed  that  the  submarine  is  onented 
with  the  bow  pointing  into  the  page.  Consistent  with  the  global  coordinate  system  from 
Chapter  II,  the  distance  from  the  surface  to  the  submarine  centerline  is  z  .  The  submarine 
diameter  is  D. 


Wave  speed, c 


Surface  elevation 
shown   at    t  =  0 


Figure  5.   Coordinate  Definition  for  plane  progressive  wave,  adapted  from  Sarpkaya  and 

Isaacson  (1981,  p.  151) 


For  a  wave  of  wavelength  L,  a  wave  number,  k,  can  be  defined. 


L 


(30) 


Assuming  that  fluid  is  incompressible  and  inviscid  Laplace's  equation  can  be  applied. 
It  is  thus  desired  to  find  a  solution  to: 


dx         dz~ 


(31) 


To  this,  the  boundary  conditions  at  the  free  surface,  and  the  bottom  must  be  applied: 
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dz 


=  0  ,  at    z  =  d  (no  flow  through  ocean  bottom) 


(32) 


— -  + —  +  —  =  0  ,  at  z-T]  (zero  velocity  normal  to  ocean  surface) 

dl       dx  ox      oz 


(33) 


d<p     1 


dx 


+  gj]  =  f(t),zt  z  =  rj 


(34) 


For  small  amplitude  waves  in  deep  water,  the  following  solution  can  be  obtained 
(adapted  from  Sarpkaya  and  Isaacson,  1981,  p.  159): 


0  = e      sin(ajf) 

kT 


k2    k 


L  = 


ill 

In 


r\  =  — cos(cur) 


C  = e  fe  cos(ax) 

2 


H 
C  =  co —  e~fc  sin(fflf) 

2 


1  -k 

C,  =  co   —e      cos(cot) 


e  "      -kz     ■    ,       s 

c  = e    -  s\n(cot) 

2 


H      , 

c,  =  -co  —  e      cos(cot) 


1  -i' 

t,  -  co'  —e    l  sin(cot) 


(35) 
(36) 

(37) 
(38) 
(39) 
(40) 
(41) 
(42) 
(43) 
(44) 
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where  77  is  the  distance  from  the  surface  to  the  average  level  (z  =  0),  wis  the  angular 
frequency  of  the  incident  wave,  £  is  the  displacement  of  a  particle  in  the  x  direction,  and  t, 
is  the  displacement  of  a  particle  in  the  z  direction. 

A  key  parameter  in  oscillating  flows  is  the  Keulegan-Carpenter  number: 

K=UjneaJ  (45) 

D 

where  Umjll  is  the  average  velocity  across  the  characteristic  dimension  D. 

By  taking  the  average  of  the  velocity  given  in  Equation  (40)  ,  and  substitution  into 
Equation  (45),  the  expression  for  the  Keulegan-Carpenter  can  be  reduced  to  the  following: 


D 


Equation  (46)  is  the  Keulegan-Carpenter  number  based  on  the  cross  flow  velocity  of  the 
undisturbed  wave  at  the  same  depth  as  the  centerline  of  the  submarine  hull. 

C.  WAVE  FORCE  REGIMES 

There  are  different  regimes  of  interaction  between  a  submerged  body  and  a  wave  field. 
Broadly,  they  can  be  broken  into  several  areas.  Inertial  interaction,  where  the  body  acts  like  a 
particle  in  the  wave  field.  Wave  diffraction,  where  the  bodies  influence  upon  the  wave  field  is 
accounted  for.  Finally,  there  are  flow  separation  (viscous)  effects.  The  relative  importance  of 
each  of  these  effects  can  be  determined  by  examining  the  relationship  the  body  size  to  the 
wave  parameters.   (Sarpkaya  and  Isaacson,  1981,  pp.  381-386) 
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Figure  6.  Wave  force  regimes  (Sarpkaya  and  Isaacson,  1981,  pg.  385) 

To  estimate  the  significant  effects  for  a  typical  SSN,  a  typical  operating  condition  is 
assumed.  For  a  300  foot  submarine  with  a  35  foot  diameter,  a  typical  periscope  operating 
depth  would  be  about  50  feet  from  the  centerline  of  the  ship  to  the  free  surface.  Using  average 
values  for  sea  states  three  and  four  and  assuming  deep  water  compared  to  the  wavelength,  the 
following  quantities  were  calculated  at  a  depth  of  50  feet: 


Parameter 

Sea  State  3 

Sea  State  4 

Significant  Wave  Height 

3 

6 

Average  Penod 

6.623501 

7.154522 

Wave  Length 

224.6467 

262.1114 

Wave  Number 

0.027969 

0.023971 

K 

0.042339 

0.103414 

D/L 

0.1558 

0.133531 

Table  2.  Estimated  Wave  Loading  Parameters 

The  Diameter/Wavelength  (D/L)  ratios  and  the  Keulegan-Carpenter  numbers  of 
Table  2  show  that  for  the  sea  states  of  interest,  wave  diffraction  much  more  significant  than 
viscous  forces.  It  can  be  concluded  that  an  inviscid  analysis  should  give  good  results  for  the 
wave  forces.  However,  this  is  only  rigorous  for  an  unappended  hull,  as  the  control  surfaces 
and  sail  on  an  actual  submarine  will  experience  viscous  effects. 
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D.  SOLUTION  FROM  SLENDER  BODY  THEORY 

Wave  force  solutions  for  several  specific  cases  were  generated  for  the  SUBOFF  by  the 
SSBN  Security  Department  of  the  Johns  Hopkins  University  Applied  Physics  Laboratory.    A 
slender  body  solution  with  some  three  dimensional  corrections  was  used.  The  specific  method 
used  for  the  generation  of  the  first  order  motions  and  second  order  forces  is  detailed  by  O'Dea 
and  Barr  (1976,  pp.  7-25). 

A  seaway  approximation  consisting  of  a  small  number  of  regular  waves  was  used  to 
model  sea  states  three  and  four.  For  each  sea  state,  the  resulting  data  were  separated  into  two 
categones.  The  effects  of  the  first  order  forces  were  given  in  terms  of  body  motions.  The 
effects  of  the  steady  second  order  forces  and  the  difference  interaction  forces  were  provided  in 
pounds  force. 

1.  Seaway  model 

A  random  seaway  can  be  represented  by  the  superposition  of  a  large  number  of  regular 
waves.  The  seaway  was  approximated  by  superimposing  «  regular  waves.  The  frequency  and 
height  of  these  waves  was  determined  using  the  Bretschneider  spectrum.  It  gives  the  spectral 
density  in  terms  of  the  significant  wave  height,  Hs ,  and  the  peak  frequency,  co0 . 


S((o)  = 


5//.2 


\6o)0(o)  /  <o„y 


"4<U„ 


(47) 


To  model  sea  state  three,  a  significant  wave  height  of  three  feet  was  used,  with  a  central 
frequency  of  0.836  radians  per  second.  This  results  in  the  following  spectrum: 
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Figure  7.  Example  Sea  State  three  spectrum 


Figure  7  gives  a  statistical  picture  of  the  seaway,  but  is  not  immediately  useful  for  time 
domain  simulation.  One  way  to  obtain  a  rime  history  is  to  represent  this  stationary  process  as 
a  the  sum  of  a  series  of  sine  waves: 

^  (48) 

1=1 


Where  A-t  is  the  amplitude  of  the  7th  wave  ,  and  a,  is  its  randomly  chosen  phase  angle. 

If  the  number  of  sine  waves  is  reasonable  large,  and  the  frequencies  and  amplitudes  of 
each  component  are  chosen  to  achieve  the  same  energy  as  the  section  of  spectrum  it 
represents,  Equation  (48)  will  give  a  good  representation  of  the  ocean  surface. 

The  method  chosen  was  to  divide  the  spectra  into  n  segments  of  equal  areas.  Thus 
results  in  n  sine  waves  all  with  equal  amplitudes.  Integration  of  Equation  (48)  yields: 
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J  S(a))da>  = 


16 


(49) 


Because  the  spectrum  extends  to  infinity,  it  was  chosen  truncate  the  spectrum  at  a 
point  where  the  area  was  a  fraction  C  of  the  total  area.  The  amount  of  area  to  be  represented 
by  each  sine  wave  is  equal  to  its  mean  square  value.  So  the  amplitude  of  each  sine  wave  is 
equal  to  the  square  root  of  the  area  it  represents  times  the  square  root  of  two. 

tf,    [C  (50) 

A-  = 


Equation  (48)  can  be  integrated  up  to  some  frequency  ati ,  which  represents  the 
frequency  at  which  the  spectral  area  is  equal  to  iC  I  n  times  the  total  area. 


\s((o)d(o  = 


H\  i 

— ■ — C 

16    n 


(51) 


Solving  Equation  (51)  for  ^yields: 


f4,  (czYl 

(1) 

=  con 

-In  — 

L5     [n)\ 

(52) 


Because  the  spectral  level  is  insignificant  below  <o  equal  to  0.6<u„ ,  the  frequency  if  the 
first  segment  was  determined  as  follows: 

(0.6<u„  +  w, )  (53) 


w,  = 


The  remainder  of  the  frequencies  were  determined  by  taking  the  midpoint  of  the 
frequencies  at  either  side  of  the  area  segment. 

®/-l  +  <°i       C~   :       n  .„  (54) 


0),   = 


for  /  =  2  to  n 
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Figure  8  illustrates  the  method  used,  approximating  the  spectrum  with  sinusoids. 
Nineteen  equal  area  sections  are  divided,  with  the  center  frequency  of  each  segment  marked 
with  a  circle. 


1.5 
omega  (rad/sec) 

Figure  8.  Spectra  area  division  and  mean  frequencies 


Figure  9  shows  the  ocean  surface  which  results  from  the  use  of  this  method  for  the 
case  of  sea  state  three,  peak  frequency  of  0.862  radians  per  second.  Nineteen  sinusoids  were 
used  to  approximate  the  spectra,  and  the  phase  angles  were  randomly  chosen. 
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Figure  9.   Sea  surface  approximation  for  sea  state  three  using  nineteen  sinusoids 

2.  First  order  forces 

The  first  order  wave  effects  were  provided  in  the  form  of  submarine  motions.  They 
were  given  as  a  senes  of  phasors,  the  real  part  of  the  summation  representing  the  actual 
perturbation  caused  by  the  first  order  wave  forces. 

0(r)  =  X"_]0,^'(a,''+a,)  (56) 


Because  the  first  order  motions  were  provided  for  a  specific  depth,  it  was  required  to 
correct  Equations  (55)  and  (56)  for  depth.  The  first  order  motions  roughly  correspond  to  the 
particle  motions  given  by  Equation  (42),  so  an  exponential  decay  was  used  to  derive  the 
following  correction  factor: 
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(57) 


e 


e 

-k,zu 


Application  of  Equation  (57)  to  Equations  (55)  and  (56)  results  in: 

z(0  =  Z"-,Z,^V=r(fl,'"+a,)"*'(z"Zo)  (58) 


0(t)  =  y£l]e,e-4:rHcj''+a')-k'u-z") 


(59) 


The  displacements  given  by  Equations  (58)  and  (59)  are  not  suitable  for  inclusion  in 
the  submanne  equations  of  motion.  For  this,  an  acceleration  is  required.  Differentiating  twice 
with  respect  to  time  results  in: 

dU)  =  -Yl=]u,2e,e~'(C0',+a')~k'u~z")  (61) 

Equations  (60)  and  (61)  were  incorporated  as  force  and  moment  disturbances  in  the 
equations  of  motion  found  in  Chapter  II.  To  test  the  validity  of  this  approach,  an  open  loop 
simulation  was  performed  using  the  accelerations  from  Equations  (60)  and  (61)  for  one  sea 
state  and  heading.  Figure  1 0  shows  the  results  of  this  simulation,  as  well  as  the  expected  first 
order  motions.  The  upper  curve  shows  the  expected  first  order  motions,  and  the  lower  curve 
shows  the  results  of  integrating  Equations  (7)  through  (11)  with  the  accelerations  from 
Equations  (60)  and  (61).    Although  there  was  some  drifting  motion,  the  character  of  motion 
and  the  approximate  amplitude  of  each  cycle  of  motion  very  close.    The  dnfting  motion  was  a 
result  lack  of  the  lack  of  open  loop  depth  stability,  which  is  characteristic  of  submannes. 
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Figure  10.   Submarine  response  to  first  order  accelerations,  and  expected  response 

3.  Second  order  forces 

For  a  particular  depth  and  wave  time  history,  the  second  order  forces  were  given  in  the 
following  form: 


/((to-wJjf+or.+a,)! 


A/ 


(0  =  I/=1  lj=xMije 


i((w,  -wy  )/+o,  +a;)l 


(62) 

(63) 


Z(t)  represents  the  force  acting  at  the  body  fixed  coordinate  system  in  the  z  direction 
and  M{t)  is  the  moment  acting  about  the  y  axis.   It  should  be  noted  that  Equations  (63)  and 
(65)  include  the  slowly  varying  forces  (/  ■*■  j)  and  the  steady  forces  (i  =  j). 
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It  can  be  determined  from  analysis  of  the  changes  of  second  order  forces  with  respect 
to  depth  given  by  Crook  (1994,  pp.  61,62)  that  the  steady  forces  with  the  following  exponential 
decay  factor: 


-2kz 


(64) 


The  slowly  varying  order  wave  forces  vary  with  depth  according  to  the  sum  of  the  wave 
numbers: 


-(k,+kj)z 


-(*,+*,  )zu 

■f  '  J         v 


Application  of  Equations  (64)  and  (65)  to  Equations  (62)  and  (63)  results  in: 


(65) 


M(0  =  Ll=]   LMMtje 


n      r     |i'((|o),  -Q)l\)t+al+aJ)-(k,+kJ)(z-z„)\ 


/(( m-iOj  )/+a,+a;)-(*,+<:;)(z-21,)j 


(66) 

(67) 


The  real  portion  of  Equations  (66)  and  (67)  represents  the  steady  and  slowly  varying 
second  order  wave  forces  acting  on  the  submarine,  with  correction  for  depth. 


4.  Inclusion  of  wave  forces  in  equations  of  motion 

The  first  order  accelerations  and  second  order  forces  had  to  be  combined  to  form  the 
force  and  moment  disturbance  accelerations  for  use  in  the  deeply  submerged  equations  of 
motion  (Equations  (7)  and  (8)). 
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(68) 
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E.  CONCLUDING  REMARKS 

An  elementary  review  of  linear  wave  theory  was  presented.  The  case  of  interest,  a 
submanne  at  periscope  depth,  was  examined  to  determine  the  salient  elements  of  its  interaction 
with  the  incident  waves.  The  parameters  suggested  that  the  major  features  of  the  incident 
wave  effects  on  the  submanne  could  be  determined  by  using  a  potential  analysis  with  inertial 
and  diffraction  forces  accounted  for. 

The  Bretschneider  spectrum  was  used  to  determine  the  spectral  density  functions  of 
the  sea  states  of  interest.  For  the  purpose  of  time  domain  simulation,  the  spectrum  was 
approximated  by  the  superposition  of  a  number  of  regular  waves  with  randomly  chosen  phase 
angles. 

The  first  order  force  transfer  function  and  second  order  forces  response  amplitude 
operators  were  provided  for  the  SUBOFF  for  a  nominal  speed  and  depth.  Approximate  depth 
scaling  was  introduced  to  allow  use  at  depths  other  than  nominal. 
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IV.        STATE  FEEDBACK  CONTROL  AT  PERISCOPE  DEPTH 

A.  INTRODUCTION 

1.  State  feedback  control 

One  popular  means  of  control  is  to  feed  back  the  system  states  after  the  application  of 
linear  gains.  System  response  of  linear  systems  subjected  to  this  type  of  control  is  predictable, 
and  a  variety  of  tools  are  available  for  control  law  gain  selection. 

The  ship's  control  party  on  a  submarine  with  conventional  indications  does  not  have 
the  full  state  of  the  ship  to  operate  from.  Although  the  actual  instrumentation  may  vary 
somewhat,  in  general  a  few  analog  indications  are  used  in  conjunction  with  a  digital  depth 
indication.  For  this  reason,  various  levels  of  partial  state  feedback  were  used  to  evaluate  the 
effects  of  missing  indications. 

The  use  of  different  state  feedback  schemes  was  felt  to  be  appropnate  to  model  human 
operators.  The  treatment  of  airplane  pilots  as  a  control  law  "has  come  to  be  recognized  as  a 
quasilinear  element  for  random-appearing  tracking  tasks  related  to  piloting.  At  the  same  time, 
the  pilot  retains  spectacular  nonlinear  gain  changing,  mode  switching,  and  goal  seeking 
precognitive  control  capabilities  as  yet  only  partially  explored."  (Graham  and  McRuer,  1991,  p. 
1093)    In  this  context,  it  was  assumed  submanne  "pilots"  could  be  treated  in  a  similar  fashion, 
with  feedback  from  each  operating  state  determined  with  linear  gains. 

The  use  of  a  first  order  lag  was  considered  to  model  the  combined  human  and  control 
surface  response  time.  It  was  found  that  reasonable  lag  values  (on  the  order  of  a  half  second) 
had  minimal  effect  on  the  control  response  and  corresponding  submarine  motions.  Because  of 
the  computational  expense,  the  control  response  time  was  neglected. 

State  feedback  control  of  the  linear  system 

k  =  Ax  +  Bu  (69) 

where: 

Ae3lmx"\  state  matnx 

Be  <&""",  control  matnx 

x  €5I°U|,  state  vector 
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u  e  9?njcl ,  control  vector 


can  be  expressed  as: 


u  =  Kx 


(70) 


where: 


KeW 


(71) 


The  system  given  by  Equation  (69)  subject  to  the  control  law  given  by  Equation  (70)  has  the 
following  closed  loop  dynamics  matrix: 

AC=(A  +  BK)  (72) 

The  eigenvalues  of  the  closed  loop  dynamics  matrix  will  be  related  to  the  system 
stability  and  responsiveness.  In  general,  the  real  portion  of  the  eigenvalues  must  be  negative 
for  system  stability.  Also  the  more  negative  the  eigenvalues,  the  faster  the  system  response. 

2.  SUBOFF  simulation  parameters 

Wave  force  data  was  available  for  the  SUBOFF  for  four  different  cases.  These  were 
sea  states  three  and  four  with  head  and  beam  directions.  All  were  valid  at  a  speed  of  six  knots 
and  depths  greater  than  fifty  feet. 

At  six  knots,  the  linear  state  representation  used  for  eigenvalue  determination  and 
control  law  design  is: 
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here: 


Fj(')=F,nm  +  FKUi,e(t) 
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MAt)  =  Mtrim  +  MwavAt) 


All  simulations  were  performed  using  the  nonlinear  equauons  of  submarine  dive  plane 
motion: 

vv  =  auuw  +  anuq  +  an  sin(0)  +  buu2 Sh  +  bnu25s  +  Fd  cos(Q)  +  euq2  +  e12qw  (74) 

q  -  a2]uw  +  a22uq  +  a2i  s'in(d)  +  b2]u  8b+b22u  5S  + Md  cos{6)  +  e2]q    +e22qw  (75) 

6  =  q  '       (76) 

Z  =  wcos(0)-usin(0)  (77) 

x  =  wsm(6)  +  ucos(0)  (78) 

The  simulations  were  performed  using  a  commanded  depth  of  55  feet  and  using  a  zero 
error  initial  state  vector.  Commanded  pitch  angle,  heave  and  pitch  rate  were  all  zero.  The 
depth  was  chosen  to  provide  a  good  representation  of  actual  submarine  periscope  operating 
depth. 

3.  State  feedback  implementation  with  SIMULINK® 

The  state  feedback  controDer  was  implemented  in  the  SIMULINK®  model  shown  in 
Figure  11.  This  block  was  designed  to  use  an  optional  feedforward  signal,  and  also  to  facilitate 
the  use  of  integral  control  (Both  feedforward  and  integral  control  are  discussed  later  in  this 
chapter).  Deflection  limits  were  placed  on  the  control  surfaces.  Control  surface  rate  limits 
were  not  included,  but  could  be  easily  added.  These  limits  are  of  interest  because  of  the 
relationships  between  control  surface  rates,  hydraulic  plant  size  requirements  and  noise  from 
control  surface  operations. 
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Figure  1 1 .  State  feedback  control  block  diagram 

A  SIMULINK®    model  was  developed  to  incorporate  the  submarine  dynamics  of 
Chapter  II,  the  wave  forces  of  Chapter  III,  and  the  state  feedback  control  law.  Also  included 
was  a  logical  means  of  adjusting  the  submarine's  trim.  This  was  done  by  adding  ballast  in  units 
of  thousands  of  pounds  at  the  center  of  buoyancy,  and  shifting  ballast  from  the  forward  trim 
tank  to  the  after  trim  tank  in  units  of  thousands  of  pounds.  The  details  of  the  trim  model  are 
shown  in  Figure  12,  while  the  overall  model  is  shown  in  Figure  13. 
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Figure  12.  SIMULINK®  trim  model 
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Figure  13.  SIMULINK®  state  feedback  control  submarine  model 

4.  Integral  control  on  depth 

To  apply  integral  control,  an  additional  state  is  introduced.  Equations  (74)  through 
(77)  are  augmented  by: 

W    ~  Z~  <■  commanded  \'  ') 

which  is  used  to  provide  state  feedback.  This  forces  the  steady  state  value  of  ^  to  zero.  In 
general,  this  approach  is  satisfactory  as  long  as  the  control  effort  does  not  become  saturated 
and  the  eigenvalues  of  the  integral  state  are  slower  than  the  state  which  is  being  zeroed. 

5.  Feedforward  of  wave  forces 

Given  the  wave  forces  values,  control  effort  can  be  directly  applied  to  eliminate  the 
average  depth  error.  With  a  constant  disturbance,  a  steady  state  value  of  the  depth  error  can  be 
determined  (Appendix  B).  Using  the  linear  equations  of  motion,  the  steady  state  depth  error 
can  be  wntten  as  a  linear  combination  of  the  net  force  and  moment  disturbances: 


Zss       Z commanded    _  ^"|  Tj  +  C2  A/j 


(80) 
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To  eliminate  the  depth  error,  it  is  required  to  apply  the  control  effort  it  applied: 


Ks=zs 


K 


24 


(81) 


Equations  (80)  and  (81)  can  be  combined  to  give  a  matrix  gain  relationship  between  the  net 
disturbance  and  the  feedforward: 


K5  = 


24 


[c,    c2] 


M. 


C\K\4        ^2^14 
C,  A' 24        ^2  ^24 


M, 


(82) 


The  state  feedback  control  law  with  feedforward  is: 

~<3, 


'* 


=  Kx  +  K 


(83) 


It  has  been  suggested  (  Musker,  Loader,  and  Butcher,  1988),  ( Ni,  Zhang,  and  Dai, 
1 994)  that  effective  periscope  depth  control  can  be  achieved  by  feeding  forward  the  average 
second  order  wave  forces.  Because  wave  forces  are  a  dynamic  disturbance  and  the  feedforward 
was  calculated  for  a  steady  disturbance,  a  filter  was  employed  to  cut  out  the  high  frequency 
components  of  the  wave  forces.  The  filter  employed  was  a  first  order  Butterworth  filter  with  a 
cut  off  frequency  cocn .  The  cut  off  frequency  was  initially  chosen  as  one  radian/second.  This 
was  well  below  the  maximum  frequency  wave  force  components  (  around  2.2  radians/second). 
Figure  14  and  Figure  15  show  the  effects  of  the  first  order  Butterworth  filter  on  the  wave 
forces  at  a  depth  of  55  feet  in  sea  state  three.  It  is  apparent  that  with  a  cutoff  frequency  of  ten 
radians  per  second,  the  filtered  forces  and  moments  are  very  close  to  the  unfiltered.  At  the 
lower  cutoff  frequency,  0.1  radians  per  second,  the  filtered  forces  and  moments  are  much 
closer  to  the  average  values. 

To  implement  the  feedforward  control  law,  it  was  assumed  that  the  net  external  force 
and  moment  were  known  quantities.  Equation  (82)  was  implemented  in  the  SIMULINK® 
model  shown  in  Figure  16  while  the  complete  system  model  is  shown  in  Figure  17. 
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Figure  14.  Filtered  wave  forces  for  sea  state  three  (head  seas) 
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Figure  15.  Filtered  wave  moments  for  sea  state  three  (head  seas) 
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Figure  16.  SIMULINK®  model  of  feedforward  calculator 
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Figure  17.  SIMULINK®  model  of  system  with  feedforward  term 

6.  Optimization  algorithm  and  parameters 

One  difficulty  of  using  partial  state  feedback  is  that  conventional  pole  placement  or 
linear  quadratic  regulator  algonthms  can  not  be  used  to  determine  the  gains.  The  gains  in 
question  were  selected  randomly,  and  gain  combinations  which  gave  stable  eigenvalues  were 
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simulated.  Because  of  the  clamping  on  the  maximum  planes  angle,  some  gains  which  yielded 
stable  eigenvalues  resulted  in  unstable  ship  control. 

Randomly  selected  gains  certainly  provide  less  than  optimum  depthkeeping.    Because 
of  this,  each  feedback  case  was  optimized  to  provide  the  best  case  for  a  particular  sea  state  and 
commanded  depth  combination.  In  conjunction  with  the  feedback  optimization,  the  trim  was 
optimized. 

The  MATLAB®  function  CONSTR  was  used  to  perform  the  optimizations. 
CONSTR  uses  the  Broyden-Fletcher-Goldfarb-Shanno  variable  metric  method,  and  supports 
constrained  optimization  problems.  To  prevent  the  optimizer  from  selecting  unstable  systems, 
a  constraint  was  placed  on  the  eigenvalues.  The  real  part  of  the  eigenvalues  was  required  to  be 
less  than  a  maximum  value,  usually  -10\ 

The  objective  of  the  optimizations  was  to  reduce  the  root  mean  square  (RMS)  value  of 
the  depth  error.  For  the  basic  state  feedback  control,  the  average  depth  was  expected  to  differ 
somewhat  from  the  commanded  depth  of  55  feet.  Because  of  this,  the  objective  for  these 
optimizations  was  to  minimize  the  RMS  value  of  the  difference  between  the  depth  and  the 
mean  depth. 

Because  the  optimizations  were  performed  without  regard  for  minimizing  control 
effort  and  or  rates,  large  gains  with  attendant  control  chatter  was  expected.  Although  control 
chatter  is  not  consistent  with  normal  submarine  operations,  it  was  neglected  to  provide  a  clear 
basis  of  companson  between  the  diffenng  levels  of  feedback. 

B.  FEEDBACK  OF  DEPTH  AND  PITCH  ANGLE 

1.  Basic  control 

An  elementary  level  of  ship  control  can  be  conducted  with  the  stern  and  bow 
planesman,  each  operating  to  control  one  particular  state.  The  logical  approach  to  this  is  for 
the  stern  planesman  to  control  the  ship's  angle,  and  the  bow  planesman  to  control  depth.  This 
results  in  the  following  control  law: 


>hP 


0    0      0       K]4 
0    0     K23       0 


commanded 
H      H commanded 

<9  —  f) 

commanded 
^       "^commanded 


(84) 
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H<«5_  (85) 

After  a  stable  set  of  random  gains  was  determined,  the  controller  was  optimized  to 
minimize  the  deviation  from  the  average  depth.  The  formal  optimization  statement 
(Vanderplaats,  1984,  p.  9)  is: 


Minimize: 


F(K„,K2i,H,F)  = 


\(z-zmean)2dt 


*s 


(86) 


where: 


z  =  depth  ,  determined  by  nonlinear  simulation 

'/ 
\{z)dt 


_  _o_ 

-mean   ~ 


H  —  Ballast  added  to  center  of  buoyancy,  thousands  of  pounds 
F  =  Ballast  shifted  from  forward  to  aft,  thousands  of  pounds 


Subject  to: 


real(eigenvalues(Ac))<Ermx  (87) 


Deviation  from  the  mean  value  of  depth,  vice  the  commanded  was  used  because  of  the 
expected  average  depth  error. 

This  approach  was  used  for  each  of  the  four  sea  state  cases.  For  sea  state  three  (head 
seas),  the  optimized  response  is  shown  in  Figure  18.  The  results  of  the  four  optimizations  are 
shown  in  Table  3.  For  the  RMS  error  and  maximum  error,  the  optimized  values  are  given, 
along  with  their  percentage  of  the  initial  values. 

In  all  cases,  use  of  the  optimization  resulted  in  reduction  of  the  mean  square  depth 
error  (measured  from  the  average  depth).   Reduction  of  the  maximum  error  was  also  achieved. 
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Sea  State /Direction 

3/head 

l).14(.S 

3/beam 
0.1465 

4/head 

4/beam 

Initial  Values 

"  ;•"""-'; ■-:".,'»?s»f£»:-g?}*ii|i 

K,4 

0.1465 

0.1465 

K23 

17.51 

17.51 

17.51 

17.51 

H/F(103  pounds) 

15/0 

15/0 

15/0 

15/0 

Mean  Depth  (feet) 

55.15 

55.20 

55.09 

55.29 

RMS  Error  (feet) 

0.9220 

0.9210 

1.23 

1.30 

Maximum  Error  (feet) 

2.46 

2.47 

3.86 

4.76 

Eigenvalues 

-0.0074  +  0.2096i 
-0.0074  -  0.2096i 

-0.0356  +  0.11441 
-0.0356 -0.11441 

-0.0074  +  0.2096i 
-0.0074  -  0.2096i 
-0.0356  +  0.11441 
-0.0356 -0.11441 

-0.0074  +  0.2096i 
-0.0074  -  0.2096i 
-0.0356  +  0.11441 
-0.0356 -0.11441 

-0.0074  +  0.2096i 
-0.0074  -  0.2096i 
-0.0356  +  0.11441 
-0.0356 -0.11441 

Optimized  Values 

|          ._  . 

1                                                4*   _-■£.'                       :,-'."      .1 

' 

KI4 

0.567 

0.2293 

0.4708 

0.2016 

K23 

63.83 

22.5724 

48.6186 

19.58 

H/F  (103  pounds) 

9.9  /  2.0 

15.8/-4.9 

15.6/-1.5 

4.9/-5 

Mean  Depth  (feet) 

54.7 

55.99 

55.12 

55.44 

RMS  Error  (feet) 

0.4550  (49%) 

0.7549  (82%) 

0.657  (53%) 

1.23(95%) 

Maximum  Error  (feet) 

1.533  (62%) 

2.03  (82%) 

2.54  (66%) 

4.15  (87%) 

Eigenvalues 

-0.0388  +  0.2392i 
-0.0388  -  0.2392i 
-0.0042  +  0.39111 
-0.0042- 0.391  li 

-0.0419  +  0.1464i 
-0.0419  -  0.1464i 

-0.0010  +  0.2346i 
-0.0010  -  0.2346i 

-0.0419  +  0.2178i 
-0.0419-0.21781 
-0.0010  +  0.3397i 
-0.0010-0.33971 

-0.0010  +  0.21941 
-0.0010-0.2194i 

-0.0419  +  0.13581 
-0.0419-0.1358i 

Table  3.   Optimized  pitch  and  depth  control  law  results  and  performance 
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Figure  18.  Simulation  with  depth  and  pitch  angle  control  in  sea  state  three  (head  sea 

direction) 

2.  Disturbance  feedforward 

The  pitch  angle  and  depth  feedback  control  can  be  implemented  with  a  disturbance 
feedforward  to  correct  average  depth  error.  This  results  in  the  following  control  law: 


-V 


0    0      0       KXA 
0    0     K23       0 


commanded 
H      H  commanded 

0  —  9 

°      ^commanded 
~       ""commanded 


(88) 


CXKU 


C2  ^,4 

0 


Fd 
M. 


\s\<smM 

where  /C5  is  given  by  Equation  (82)  and  the  force  and  moment  disturbances  are  filtered. 


(89) 
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After  a  stable  set  of  random  gains  was  determined,  the  controller  was  optimized  to 
minimize  the  deviation  from  the  average  depth.  The  formal  optimization  statement  is: 


J  \<-       '-■cummuncleJ  ' 


<1 


Subject  to: 

real(eigenvalues(Ac))  <  £max  (91) 

This  approach  was  used  for  each  of  the  four  sea  state  cases.  For  sea  state  three  (head 
seas),  the  optimized  response  is  shown  in  Figure  19.  The  results  of  the  four  optimizations  are 
shown  in  Table  4.  For  the  RMS  error  and  maximum  error,  the  optimized  values  are  given, 
along  with  their  percentage  of  the  initial  values. 
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Sea  State/Direction 

3/head 

3/beam 

4/head 

4/beam 

Initial  Values 

Ku 

0.1465 

0.1465 

0.1465 

0.1465 

Ka 

17.51 

17.51 

17.51 

17.51 

Q)co  (rad/sec) 

1 

1 

1 

1 

H/F(103  pounds) 

20/0 

20/0 

20/0 

20/0 

Mean  Depth  (feet) 

55.07 

56.7 

55.826 

61.33 

RMS  Error  (feet) 

0.408 

2.24 

1.71 

6.93 

Maximum  Error  (feet) 

1.104 

5.27 

3.71 

13.46 

Eigenvalues 

-0.0074  +  0.2096i 
-0.0074  -  0.2096i 
-0.0356  +  0.11441 
-0.0356  -0.11441 

-0.0074  +  0.2096i 
-0.0074  -  0.2096i 
-0.0356  +  0.11441 
-0.0356  -  0.1144i 

-0.0074  +  0.2096i 
-0.0074  -  0.2096i 
-0.0356  +  0.11441 
-0.0356 -0.1144i 

-0.0074  +  0.2096i 
-0.0074  -  0.2096i 

-0.0356  +  0.11441 
-0.0356 -0.11441 

Optimized  Values 

KH 

1.116 

3.5763 

7.40 

3.396 

Kb 

151.00 

454.7 

1,073.6 

979.02 

(0C0  (rad/sec) 

0.743 

3.30 

6.83 

6.43 

H/F  (103  pounds) 

19.5/3.5 

22.1/1.3 

26.5/3.25 

8.4/-4.0 

Mean  Depth  (feet) 

54.996 

55.14 

55.04 

55.21 

RMS  Error  (feet) 

0.102(25%) 

0.556  (25%) 

0.810  (47%) 

0.883  (13%) 

Maximum  Error  (feet) 

0.322  (29%) 

2.24  (43%) 

0.560  (15%) 

3.36  (25%) 

Eigenvalues 

-0.0337  +  0.3345i 
-0.0337  -  0.3345i 
-0.0092  +  O.6O881 
-0.0092  -  O.6O881 

-0.0354  +  0.6055i 
-0.0354  -  0.6055i 
-0.0076  +  1.0490i 
-0.0076-  1.0490i 

-0.0322  +  0.8604i 
-0.0322  -  0.8604i 
-0.0107  +  1.6296i 
-0.0107-1.6296i 

-0.0250  +  0.5675i 
-0.0250  -  0.5675i 
-0.0179  +  1.6019i 
-0.0179-  1.6019i 

Table  4.   Optimized  pitch  and  depth  control  law  with  disturbance  feedforward  results  and 

performance 
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Figure  19.   Simulation  with  depth  and  pitch  angle  control  with  disturbance  feedforward,  sea 

state  three  (head  seas) 

3.  Integral  control 

The  feedback  of  depth  and  pitch  angle  can  be  augmented  with  integral  control  on 
depth  to  remove  the  average  depth  error.  Since  the  bow  planes  are  principally  used  for  the 
control  of  depth,  the  integral  control  was  applied  to  the  bow  planes  only.  This  results  in  the 
following  control  law: 
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'bp 


0     0       0 


K 


0     0     K2y        0 


•M5 

0 


W  —   W  II 

commanded 

H       H  commanded 

B  —  G 

commanded 

**       ^commanded 


(92) 


1*1  *  S« 


(93) 


After  a  stable  set  of  random  gains  was  determined,  the  controller  was  optimized  to 
minimize  the  deviation  from  the  commanded  depth.  The  formal  optimization  statement  is: 


Minimize: 


F(Kl4,Kl5,Kn,H,F)  = 


If     _  2 

J  \£        ^-commanded   '     w 


(94) 


Subject  to: 


real(eigenvalues(Ac))  <  ET 


(95) 


This  approach  was  used  for  each  of  the  four  sea  state  cases.  For  sea  state  three  (head 
seas),  the  optimized  response  is  shown  in  Figure  20.  The  results  of  the  four  optimizations  are 
shown  in  Table  5. 
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Sea  State/Direction 

3/head 

3 /beam 

4/head 

4/beam 

Initial  Values 

■ 

Km 

0.1465 

0.1465 

0.1465 

0.1465 

K,5 

0.001 

0.001 

0.001 

0.001 

Kb 

17.51 

17.51 

17.51 

17.51 

H/F  (W  pounds) 

20/0 

20/0 

20/0 

20/0 

Mean  Depth  (feet) 

55.15 

55.16 

55.19 

55.24 

RMS  Error  (feet) 

0.987 

0.986 

1.29 

1.39 

Maximum  Error  (feet) 

2.614 

2.63 

4.01 

5.12 

Eigenvalues 

-0.0077  +  0.2088i 
-0.0077  -  0.2088i 
-0.0318  +  0.1148i 
-0.0318  -  0.1148i 
-0.0070 

-0.0077  +  0.2088i 
-0.0077  -  0.2088i 
-0.0318  + 0.1 148i 
-0.0318 -0.1148i 
-0.0070 

-0.0077  +  0.2088i 
-0.0077  -  0.2088i 
-0.0318  +  0.11481 
-0.0318 -0.1148i 
-0.0070 

-0.0077  +  0.2088i 
-0.0077  -  0.2088i 
-0.0318  +  0.11481 
-0.0318 -0.11481 
-0.0070 

Optimized  Values 

"..'.'       '  :'     ..'    -.               ! 

'        .  .  .: 

-                               ■ 

":' 

Kl4 

1.5609 

0.6329 

0.2906 

0.296 

K15 

0.0019 

0.0012 

0.0004 

0.0005 

Kb 

304.5 

107.76 

28.46 

76.53 

H/F  (103  pounds) 

18.2/1.4 

20.0/0.1 

18.1/-3.4 

12.2/-4.2 

Mean  Depth  (feet) 

55.01 

55.09 

55.05 

55.11 

RMS  Error  (feet) 

0.455  (46%) 

0.3811  (39%) 

0.865  (67%) 

1.05(76%) 

Maximum  Error  (feet) 

2.035  (78%) 

1.0138(39%) 

3.38  (84%) 

3.53  (69%) 

Eigenvalues 

-0.0149  +  0.8824i 
-0.0149-0.88241 
-0.0274  +  0.3887i 
-0.0274  -  0.3887i 
-0.0012 

-0.0134  +  0.5221i 

-0.0134-0.5221i 

-0.0286  +  0.2475i 

-0.0286  -  0.2475i 

-0.0020 

-0.0001  +0.2615i 
-0.0001-0.26151 

-0.0421  +0.1675i 

-0.0421  -01675i 

-0.0015 

-0.0163  +  0.4296i 
-0.0163-0.42961 

-0.0258  +  0.17071 

-0.0258-0.1707i 

-0.0015 

Table  5.  Optimized  pitch  and  depth  integral  control  law  results  and  performance 
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Figure  20.  Simulation  with  depth,  pitch  angle,  and  integral  control,  sea  state  three  (head 

seas) 

C.  FULL  STATE  FEEDBACK  WITH  PARTIAL  DISTRIBUTION 

1.  Basic  control 

The  poor  depth  control  of  the  previous  section  can  be  improved  be  adding  to  the 
number  of  states  fed  back.  In  keeping  with  previous  logic,  the  bow  planes  will  be  controlled 
by  the  depth  and  heave,  while  the  stern  planes  will  be  controlled  by  pitch  and  pitch  rate.  This 
results  in  the  following  control  law: 
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>bp 


ff.l 

0       K 


22 


0        Ku 
K^       0 


H^n 


commanded 
t       t commanded 

0  —  0 

commanded 
*-       ^commanded 


(96) 


(97) 


After  a  stable  set  of  random  gains  was  determined,  the  controller  was  optimized  to 
minimize  the  deviation  from  the  average  depth.  The  formal  optimization  statement  is: 


Minimize: 


F(K,ttK,A,KTi,Kz,,H,F)  - 


\ U  -  zmean)2 dt 


(98) 


Subject  to: 


real{eigenvalues{Ac))  <  En 


(99) 


This  approach  was  used  for  each  of  the  four  sea  state  cases.  For  sea  state  three  (head 
seas),  the  optimized  response  is  shown  in  Figure  21.  The  results  of  the  four  optimizations  are 
shown  in  Table  6. 
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Sea 
State/Direction 

3/head 

3/beam 

4/head 

4/beam 

Initial  Values 

■'•''■''-■              '".  "    '     ~:. ^.iVW.'C"  fl'.'t 

-■ ;.  ■   •■     "  r  ••  \ 

KT 

12.5543 

0 

0 

2.5490 

0 
22.5268 
24.9900 

0 

12.5543 

0 

0 

2.5490 

0 
22.5268 
24.9900 

0 

12.5543 

0 

0 

2.5490 

0 
22.5268 
24.9900 

0 

12.5543 

0 

0 

2.5490 

0 
22.5268 
24.9900 

0 

H/F  (103  pounds) 

20/0 

20/0 

20/0 

20/0 

Mean  Depth  (feet) 

55.06 

55.33 

55.21 

55.73 

RMS  Error  (feet) 

0.216 

0.425 

0.412 

1.06 

Maximum  Error  (feet) 

0.796 

1.38 

1.26 

3.38 

Eigenvalues 

-0.6743 

-0.0413  +  0.3587i 

-0.0413  -  0.3587i 

-0.1789 

-0.6743 
-0.0413  +  0.3587i 
-0.0413-0.3587i 

-0.1789 

-0.6743 

-0.0413  +  0.3587i 

-0.0413-0.3587i 

-0.1789 

-0.6743 

-0.0413  +  0.3587i 

-0.0413  -  0.3587i 

-0.1789 

Optimized  Values 

KT 

0 

0 

89.26 

0 
1366.3 
1163.3 

0 

7.035 
0 
0 

3.813 

0 
91.224 
20.87 

0 

13.265 
0 
0 

2.1048 

0 
91.49 
51.15 

0 

16.53 
0 
0 

15.33 

0 
96.44 
82.43 

0 

H/F  (103  pounds) 

14.6/-1.4 

12.3/-0.4 

20.0/0.1 

16.8/0.0 

Mean  Depth  (feet) 

55.02 

55.01 

55.21 

55.09 

RMS  Error  (feet) 

0.1969(91%) 

0.350  (82%) 

0.358  (87%) 

0.821  (77%) 

Maximum  Error  (feet) 

1.17(147%) 

0.99  (72%) 

1.13  (90%) 

3.46  (102%) 

Eigenvalues 

-3.3197 

-0.0693  +  1.2522i 

-0.0693-  1.2522i 

-0.1879 

-0.1266  +  0.4709i 
-0.1266-0.4709i 
-0.2619  +  0.0179i 
-0.2619-0.0179i 

-0.7286 

-0.1458  +  0.4700i 

-0.1458  -  0.4700i 

-0.1514 

-0.2213  +  O.886I1 
-0.2213-0.8861i 

-0.3797  +  0.4819i 
-0.3797-0.4819i 

Table  6.   Full  state  feedback  (partial  distribution)  control  law  optimization  results  and 

performance 
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Figure  21.   Simulation  with  full  state  partial  distribution  feedback  control,  sea  state  three 

(head  seas) 

2.  Disturbance  feedforward 

As  before,  the  basic  control  law  can  be  modified  to  include  a  feedforward  term  to 
correct  the  average  depth  error. 


JbP 


A\ 
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0       K, 


0  ^22  23 


commanded 

H        i  commanded 

f)  —  f) 

u         commanded 

^       ^-commanded 


C\K\4 
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(100) 
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(101) 


49 


After  a  stable  set  of  random  gains  was  determined,  the  controller  was  optimized  to 
minimize  the  deviation  from  the  average  depth.  The  formal  optimization  statement  is: 


Minimize: 


F(Ku,Kl4,Kn,K23,a>m,H,F)  = 


J  \Z       ?■  commanded  '     "* 


h 


(102) 


Subject  to: 

real{eigenvalues(Ac))  <  £max  (103) 

This  approach  was  used  for  each  of  the  four  sea  state  cases.  For  sea  state  three  (head 
seas),  the  optimized  response  is  shown  in  Figure  22.  The  results  of  the  four  optimizations  are 
shown  in  Table  7. 
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Sea 
State/Direction 

3/head 

3/beam 

4/head 

4/beam 

Initial  Values 

KT 

12.5543 

0 

0 

2.5490 

0 
22.5268 
24.9900 

0 

12.5543 

0 

0 

2.5490 

0 

22.5268 
24.9900 

0 

12.5543 

0 

0 

2.5490 

0 
22.5268 
24.9900 

0 

12.5543 

0 

0 

2.5490 

0 
22.5268 
24.9900 

0 

Q)a>  (rad/sec) 

1 

1 

1 

1 

H/F  (103  pounds) 

20/0 

20/0 

20/0 

20/0 

Mean  Depth  (feet) 

55.16 

55.35 

55.23 

55.82 

RMS  Error  (feet) 

0.371 

0.533 

0.551 

1.40 

Maximum  Error  (feet) 

1.264 

1.83 

1.72 

3.50 

Eigenvalues 

-0.6743 

-0.0413  +  0.3587i 

-0.0413-0.3587i 

-0.1789 

-0.6743 
-0.0413  +  0.3587i 
-0.0413-0.3587i 

-0.1789 

-0.6743 

-0.0413  +  0.3587i 

-0.0413-0.3587i 

-0.1789 

-0.6743 

-0.0413  +  0.3587i 

-0.0413-0.3587i 

-0.1789 

Optimized  Values 

: 

'''"."' :       r>i'.-i:-      - 

KJ 

25.81 

0 

0 
3.5847 

0 

175.77 

26.1 

0 

15.73 

0 

0 
9.446 

0 
230.65 
535.98 

0 

12.74 

0 

0 
2.70 

0 
18.09 
20.1 

0 

16.87 

0 

0 
3.714 

0 
9.197 
18.12 

0 

0)CII  (rad/sec) 

0.481 

3.80 

0.998 

0.999 

H/F  (103  pounds) 

7.1/-3.3 

19.7/-2.5 

20.0/0.0 

19.7/0.0 

Mean  Depth  (feet) 

55.01 

55.23 

55.18 

55.63 

RMS  Error  (feet) 

0.0785  (21%) 

0.3624  (68%) 

0.5171  (94%) 

1.25(89%) 

Maximum  Error  (feet) 

0.246  (19%) 

1.07  (58%) 

2.03(118%) 

3.26  (93%) 

Eigenvalues 

-1.1709 
-0.5214 
-0.0948 
-0.3993 

-0.1692  +  1.3601i 
-0.1692-  1.360H 

-0.6826  +  0.4529i 
-0.6826  -  0.4529i 

-0.6730 

-0.0429  +  0.3320i 

-0.0429  -  0.3320i 

-0.1767 

-0.9159 

-0.0386  +  0.31731 

-0.0386-0.3173i 

-0.1769 

Table  7.   Full  state  feedback  (partial  distribution)  with  disturbance  feedforward  control  law 

opdmizadon  results  and  performance 
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Figure  22.  Simulation  with  full  state  partial  distribution  control  and  disturbance 
feedforward,  sea  state  three  (head  seas) 

3.  Integral  Control 

This  full  state  feedback  with  partial  distribution  was  augmented  with  integral  control 
on  depth  to  remove  the  average  depth  error.  As  before,  the  integral  control  was  done  using 
the  bow  planes  only.  This  results  in  the  following  control  law: 


JbP 


K, 
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f)  —  ft 
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^      ^commanded 
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After  a  stable  set  of  random  gains  was  determined,  the  controller  was  optimized  to 
minimize  the  deviation  from  the  average  depth.  The  formal  optimization  statement  is  as 
follows: 


Minimize: 


)(z-zmean)2dt 


(106) 


F(A"| , ,  K]4 ,  A"15,  K22 1  K2y,H ,  F) 


h 


Subject  to: 


real(eigenvalues(Ac))  <  £max  (107) 


This  approach  was  used  for  each  of  the  four  sea  state  cases.  For  sea  state  three  (head 
seas),  the  optimized  response  is  shown  in  Figure  23.  The  results  of  the  four  optimizations  are 
shown  in  Table  8. 
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Sea  State/Direction 

3/head 

3/beam 

4/head 

4/beam 

Initial  Values 

I ~.~       * 

HP     '    *  •" '  x  '';  ''>* " 

■  ■                      ~   . 

KJ 

12.5543 

0 

0 

2.5490 

0.0010 

0 
22.5268 
24.9900 

0 
0 

12.5543 

0 

0 

2.5490 

0.0010 

0 
22.5268 
24.9900 

0 

0 

12.5543 

0 

0 

2.5490 

0.0010 

0 
22.526 

8 
24.990 

0 

12.5543 

0 

0 

2.5490 

0.0010 

o 

22.526 

8 
24.99 

0 

H/F(103  pounds) 

20/0 

20/0 

20/0 

20/0 

Mean  Depth  (feet) 

55.05 

55.31 

55.21 

55.74 

RMS  Error  (feet) 

0.2106 

0.533 

0.4868 

1.205 

Maximum  Error  (feet) 

0.866 

1.723 

1.82 

3.43 

Eigenvalues 

-0.6744 
-0.0412  +  0.3587i 
-0.0412-0.3587i 

-0.1785 

-0.0004 

-0.6744 
-0.0412  +  0.3587i 
-0.0412-0.35871 

-0.1785 

-0.0004 

-0.6744 
-0.0412  +  0.3587i 
-0.0412-0.3587i 

-0.1785 

-0.0004 

-0.6744 
-0.0412  + 
0.3587i 
-0.0412-0.3587i 
-0.1785 
-0.0004 

Optimized  Values 

'jsi**  ■.. 

K7 

523.12 

0 

0 

89.26 

.04016 

0 
1366.3 
1163.3 

0 

0 

385.2 

0 

0 
254.4 
0.0077 

0 
874.3 
1400.5 

0 

0 

14.074 

0 

0 
2.146 
0.0003 

0 
73.89 
21.85 

0 

0 

70.08 

0 

0 
52.88 
0.0032 

0 
353.83 
54.45 

0 

H/FOO^  pounds) 

14.6/-1.4 

26.7/4.6 

21.2/-0.2 

10.5/-2.6 

Mean  Depth  (feet) 

55.02 

55.05 

55.25 

55.18 

RMS  Error  (feet) 

0.059  (28%) 

0.3017  (57%) 

0.4274  (88%) 

0.909  (75%) 

Maximum  Error  (feet) 

0.248  (29%) 

0.862  (50%) 

1.16(64%) 

3.59  (105%) 

Eigenvalues 

-30.7579 
-4.6840 
-1.0562 
-0.1695 
-0.0005 

-22.3751 
-1.8146  +  1.6555i 
-1.8146-  1.6555i 

-0.6572 

0.00003 

-0.7495 
-0.1526  +  0.3297i 
-0.1526-0.3297i 

-0.1168 

-0.0001 

-3.4631 
-1.4563 
-0.9504 
-0.1490 
-0.0001 

Table  8.  Full  state  feedback  (partial  distribution)  integral  control  law  optimization  results  and 

performance 
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Figure  23.  Simulation  with  full  state  partial  distribution  feedback  integral  control,  sea  state 

three  (head  seas) 


D.         FULL  STATE  FEEDBACK 
1.  Basic  control 

The  best  control  possible  using  state  feedback  should  result  from  the  use  of  all  four 
states  by  each  control.  This  results  in  the  following  control  law: 
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Kn      Kn     Kl4 

"22        "21  24 


H  *  ^ 


'  commanded 


W  -  Vl't 

H        1  commanded 

0  —  0 

u  commanded 

*•       *■  commanded 


(108) 


(109) 


After  a  stable  set  of  gains  was  determined  using  a  Linear  quadratic  regulator  algorithm, 
the  controller  was  optimized  to  minimize  the  deviation  from  the  average  depth.  The  formal 
optimization  statement  was: 
Minimize: 


\(z-zmean)2dt 


F{Kn,Kn,Kn,KXA,Klx, K22 , Kiy , K24 ,H,F)  - 


(110) 


Subject  to: 


real{eigenvalues(Ac))  <  E^ 


(111) 


This  approach  was  used  for  each  of  the  four  sea  state  cases.  For  sea  state  three  (head 
seas),  the  optimum  response  is  shown  in  Figure  24.  The  results  of  the  four  optimizations  are 
shown  in  Table  9. 
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Sea  State/Direction 

3/head 

3/beam 

4/head 

4/beam 

Initial  Values 

KT 

6.847 

5.1622 

6.847 

5.1622 

6.847 

5.1622 

6.847 

5.1622 

-168.26 

121.32 

-168.26 

121.32 

-168.26 

121.32 

-168.26 

121.32 

-65.795 

27.744 

-65.795 

27.744 

-65.795 

27.744 

-65.795 

27.744 

0.9740 

-0.0789 

0.9740 

-0.0789 

0.9740 

-0.0789 

0.9740 

-0.0789 

H/F(1CV  pounds) 

20/0 

20/0 

20/0 

20/0 

Mean  Depth  (feet) 

55.09 

55.37 

55.21 

56.16 

RMS  Error  (feet) 

0.0914 

0.3605 

0.355 

1.60 

Maximum  Error  (feet) 

0.262 

1.34 

1.09 

4.55 

Eigenvalues 

-0.8859 

-0.8859 

-0.8859 

-0.8859 

-0.2854 

-0.2854 

-0.2854 

-0.2854 

-0.1630  +  0.2247i 

-0.1630 +  0.2247i 

-0.1630 +  0.2247i 

-0.1630  +  0.2247i 

-0.1630-0.22471 

-0.1630-0.2247i 

-0.1630-0.22471 

-0.1630-0.2247i 

Optimized  Values 

■':      '      \        ■ 

KJ 

10.300 

9.638 

4.591 

11.31 

4.591 

11.306 

3.503 

11.5734 

45.790 

170.45 

-283.9 

78.91 

-283.9 

78.91 

-374.02 

178.92 

-135.16 

39.390 

125.7 

-1.333 

-125.7 

-1.333 

-66.65 

40.760 

3.6389 

0.0308 

1.457 

0.1568 

1.457 

0.1568 

0.446 

0.0221 

H/F  (103  pounds) 

20.1 /-0.9 

18.0/-0.3 

18.0/-0.33 

19.9/0.0 

Mean  Depth  (feet) 

55.03 

55.13 

55.13 

56.54 

RMS  Error  (feet) 

0.037  (40%) 

0.2638  (73%) 

0.2683  (76%) 

1.24(78%) 

Maximum  Error  (feet) 

0.119(45%) 

0.961  (72%) 

0.961  (88%) 

4.06  (89%) 

Eigenvalues 

-1.7613 

-1.0446 

-1.0446 

-1.0313  +  0.4218i 

-0.2510 

-0.3493  +  0.2881i 

-0.3493  +  0.2881i 

-1.0313-0.4218i 

-0.0617 +  0.5264i 

-0.3493  -  0.2881i 

-0.3493  -  0.288H 

-0.0936  +  0.0741i 

-0.0617-0.52641 

-0.2053 

-0.2053 

-0.0936-0.07411 

Table  9.  Full  state  feedback  control  law  optimization  results  and  performance 
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Figure  24.   Full  state  feedback  optimized  control  simulation,  sea  state  three  (head  seas) 

2.  Disturbance  feedforward 

The  state  feedback  control  law  was  modified  to  include  disturbance  feedforward.  This 
results  in  the  following  control  law: 
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After  a  stable  set  of  gains  was  determined  using  a  linear  quadratic  regulator  algorithm, 
the  controller  was  optimized  to  minimize  the  deviation  from  the  average  depth.  The  formal 
optimization  statement  was: 


Minimize: 


-  2 

J  \<,       ^commanded  * 


(114) 


F(Ku,K]2,Kl3,Kl4,  K2X ,  K22  ,  K2?l ,  K24  ,  cocn ,  H,  F) 


h 


Subject  to: 

real(eigenvalues{  Ac ))  <  Emax  (1 1 5) 

This  approach  was  used  for  each  of  the  four  sea  state  cases.  For  sea  state  three  (head 
seas),  the  optimum  response  is  shown  in  Figure  25.  The  results  of  the  four  optimizations  are 
shown  in  Table  1 0. 
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Sea  State/Direction 

3/head 

3/beam 

4/head 

4/beam 

Initial  Values 

KT 

6.847 
-168.26 
-65.795 
0.9740 

5.1622 
121.32 
27.744 
-0.0789 

6.847 
-168.26 
-65.795 
0.9740 

5.1622 
121.32 
27.744 
-0.0789 

6.847 
-168.26 
-65.795 
0.9740 

5.1622 
121.32 
27.744 
-0.0789 

6.847 
-168.26 
-65.795 
0.9740 

5.1622 
121.32 
27.744 
-0.0789 

C0co  (rad/sec) 

1 

1 

1 

1 

H/F(103  pounds) 

20/0 

20/0 

20/0 

20/0 

Mean  Depth  (feet) 

55.06 

55.937 

55.21 

56.70 

RMS  Error  (feet) 

0.1428 

1.343 

0.430 

2.393 

Maximum  Error  (feet) 

0.4897 

3.46 

1.11 

5.49 

Eigenvalues 

-0.8859 

-0.2854 
-0.1630  +  0.22471 
-0.1630-0.2247i 

-0.8859 

-0.2854 
-0.1630  +  0.2247i 
-0.1630-0.22471 

-0.8859 

-0.2854 

-0.1630  +  0.2247i 

-0.1630-0.2247i 

-0.8859 

-0.2854 

-0.1630  +  0.2247i 

-0.1630-0.2247i 

Optimized  Values 

KT 

-262 

-1633 

-368.8 

5 

96.5 

914.4 
91.9 
-1.2 

0.3964 

-879.14 

-297.0 

3.52 

11.08 

329.16 

-91.096 

0.215 

20.60 
-194.6 
27.66 
-0.276 

-2.681 

181.5 

48.6 

-0.238 

5.00 

-452.53 

25.47 

6.66 

-3.94 
609.1 
449.5 
0.318 

C0co  (rad/sec) 

1.4046 

1.033 

0.983 

1.739 

H/F(103  pounds) 

13.5/-0.8 

19.16/-0.2134 

19.0/-0.1 

18.8/-0.1 

Mean  Depth  (feet) 

55.0013 

55.18 

55.18 

55.22 

RMS  Error  (feet) 

0.0928  (65%) 

0.4121  (31%) 

0.400  (36%) 

0.792  (33%) 

Maximum  Error  (feet) 

0.2852  (58%) 

1.62(47%) 

1.117(101%) 

2.23  (41%) 

Eigenvalues 

-7.0391 
-4.6280 
-0.1322  +  0.1329i 
-0.1322-0.1329i 

-0.8095  +  0.5268i 

-0.8095  -  0.5268i 

-1.1529 

-0.0315 

-1.1927 

-0.2499  +  0.3312i 

-0.2499-0.3312i 

-0.0618 

-0.0898  +  0.9297i 

-0.0898  -  0.9297i 

-1.1834 

-0.6517 

Table  10.  Full  state  feedback  control  law  with  disturbance  feedforward  optimization  results 

and  performance 
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Figure  25.   Full  state  feedback  control  with  disturbance  feedforward  optimized  control 

simulation,  sea  state  three  (head  seas) 


3.  Integral  control 

This  full  state  feedback  with  partial  distribution  was  augmented  with  integral  control 
on  depth  to  remove  the  average  depth  error.  Since  the  bow  planes  are  principally  used  for  the 
control  of  depth,  the  integral  control  was  done  using  the  bow  planes  only.  This  results  in  the 
following  control  law: 


>bP 


A', 


Kn      K\i      K\4      K\s 


K2X      K22      K2?t     K24 


A  *   ^ 


K 


25 


IV- 

commanded 

R- 

"  commanded 

e- 

-  (9 

commanded 

z- 

*•  commanded 

Z; 

(116) 


(117) 
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After  a  stable  set  of  random  gains  was  determined,  the  controller  was  optimized  to 
minimize  the  deviation  from  the  average  depth.  The  formal  optimization  statement  is: 


Minimize: 


F(Kn,  AT,2  ,  ^13  '  ^14  >  ^15  '^21  '^22  >^23  >  ^24  ,K2S,H,F)  - 


j 

J  ^       ^-commanded  ' 


'/ 


(118) 


Subject  to: 

real(eigenvalues(  Ac ))  <  £'max  (1 1 9) 

This  approach  was  used  for  each  of  the  four  sea  state  cases.  For  sea  state  three  (head 
seas),  the  optimum  response  is  shown  in  Figure  26.  The  results  of  the  four  optimizations  are 
shown  in  Table  1 1 . 
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Sea  State/Direction 

3/head 

3/beam 

4/head 

4/beam 

Initial  Values 

- 

K'1 

6.847 

5  1622 

6.847 

5.1622 

6.847 

5.1622 

6.847 

5.1622 

-168.26 

121.32 

-168.26 

121.32 

-168.26 

121.32 

-168.26 

121.32 

-65.795 

27.744 

-65.795 

27.744 

-65.795 

27.744 

-65.795 

27.744 

0.9740 

-0.0789 

0.9740 

-0.0789 

0.9740 

-0.0789 

0.9740 

-0.0789 

0.01 

-0.01 

0.01 

-0.01 

0.01 

-0.01 

0.01 

-0.01 

H/F(103  pounds) 

20/0 

20/0 

20/0 

20/0 

Mean  Depth  (feet) 

55.01 

55.02 

54.78 

54.68 

RMS  Error  (feet) 

0.101 

0.415 

0.573 

2.483 

Maximum  Error  (feet) 

0.3065 

1.545 

1.79 

6.927 

Eigenvalues 

-0.8854 

-0.8854 

-0.8854 

-0.8854 

-0.2693 

-0.2693 

-0.2693 

-0.2693 

-0.1652  +  0.21531 

-0.1652  +  0.21531 

-0.1652  +  0.2153i 

-0.1652  +  0.21531 

-0.1652-0.21531 

-0.1652-0.21531 

-0.1652  -  0.2153i 

-0.1652-0.2153i 

-0.122 

-0.122 

-0.122 

-0.122 

Optimized  Values 

K7 

240.17 

24.2736 

1.3875 

7.5561 

13.059 

4.681 

-1.679 

6.870 

-137.3 

256.28 

-158.91 

153.309 

-146.54 

155.09 

-234.17 

257.016 

-195.76 

84.99 

-52.850 

39.280 

-36.04 

42.31 

-94.42 

48.260 

36.65 

0.1753 

0.4948 

-0.0550 

0.9425 

-0.0484 

1.140 

-0.0327 

0.162 

-0.0128 

0.0109 

0.0069 

0.013 

-0.0037 

0.0111 

-0.0105 

H/F  (103  pounds) 

20.7/1.9 

19.1/0 

20/0 

19.9/0.0 

Mean  Depth  (feet) 

55.00 

55.00 

54.99 

54.92 

RMS  Error  (feet) 

0.0414(14%) 

0.372  (90%) 

0.536  (93%) 

1.96(79%) 

Maximum  Error  (feet) 

0.175  (57%) 

1.01  (65%) 

1.57(88%) 

6.88  (99%) 

Eigenvalues 

-17.3244 

-0.8739 

-1.2707 

-1.0690 

-0.7017 

-0.1541  +0.1441i 

-0.2086  +  0.1628i 

-0.1214  +  0.3327i 

-0.1942 +  0.4296i 

-0.1541  -0.14411 

-0.2086  -  0.1628i 

-0.1214-0.33271 

-0.1942  -0.4296i 

-0.2567 

-0.2056 

-0.2428 

-0.0076 

-0.0375 

-0.0208 

-0.0012 

Table  1 1 .  Full  state  feedback  integral  control  law  optimization  results  and  performance 
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Figure  26.   Optimized  full  state  feedback  with  integral  control  simulation,  sea  state  three 

(head  seas) 

E.  CONCLUDING  REMARKS 

For  each  case  of  feedback  control,  the  degree  of  control  achieved  generally  improved 
by  the  additional  state  feedbacks.  Full  distribution  of  each  state  to  both  controls  further 
reduced  the  error.  Table  12  provides  a  summary  of  the  optimizations  performed,  and  the  RMS 
error  of  each  one. 

Changes  in  the  optimized  trim  and  control  law  in  all  cases  varied  substantially  with 
changes  in  sea  state  or  direction.  This  is  consistent  with  operational  experience. 

Each  controller  was  optimized  with  only  the  goal  of  minimizing  the  mean  square  of 
the  depth  error.  This  resulted  in  large  gains  and  excessive  control  effort.  In  addition,  large 
rates  of  control  were  experienced.  This  would  be  detrimental  for  actual  submarine  operations, 
as  there  are  rate  limits  associated  with  the  control  surfaces.  These  limits  come  from  the  sizing 
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of  the  hydraulic  plants  which  drive  the  planes,  and  operation  concerns  related  to  plane  induced 
noise. 

Some  improvements  in  depthkeeping  were  achieved  by  the  feedforward  of  the 
disturbance  forces.  This  is  in  spite  of  the  feedforward  being  based  on  a  steady  state  response 
to  a  constant  disturbance. 


Sea  State/Direction 

3/Head 

3/Beam 

4/Head 

4/Beam 

Control  Scheme 

Depth  and  Pitch  Angle 

0.4550 

0.7549 

0.657 

1.23 

Depth  and  Pitch  angle  with  feedforward 

0.102 

0.556 

0.810 

0.883 

Depth  and  Pitch  angle  with  integral 

0.455 

0.3811 

0.865 

1.05 

Full  State  with  partial  distribution 

0.1969 

0.350 

0.358 

0.821 

Full  State  with  partial  distribution  and  feedforward 

0.0785 

0.3624 

0.5171 

1.25 

Full  State  with  partial  distribution  and  integral 

0.059 

0.3017 

0.4274 

0.909 

Full  State 

0.037 

0.2638 

0.2683 

1.24 

Full  State  with  feedforward 

0.0928 

0.4121 

0.400 

0.792 

Full  State  integral 

0.0414 

0.372 

0.536 

1.96 

Table  12.   Optimized  RMS  error  (feet)  of  state  feedback  control  schemes 
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V.  SLIDING  MODE  CONTROL 

A.  INTRODUCTION 

1.  Overview  of  MIMO  sliding  mode  control 

The  controller  design  starts  with  a  standard  linear  state  space  representation: 

x=Ax  +  Bu  (120) 

where: 

Ae3imxm,  state  matrix 

B  e  9T™,  control  matrix 

x  e^imxi  ,  state  vector 

«e5i"'  ,  control  vector 

The  sliding  mode  control  law,  u,  is  composed  of  two  main  parts: 

u  =  u  +  u  (121) 

The  first  part,  u  ,  is  a  linear  feedback  based  on  the  linear  representation  given  by  Equation 
(120).  The  second  part,  u  ,  are  nonlinear  feedbacks  with  their  signs  switching  depending  on 
the  relationship  of  the  system  states  to  the  sliding  surfaces.  The  sliding  surfaces  are  hyper 
planes  in  the  state  space,  with  one  for  each  control.  They  are  defined  by: 

a(x)  =  STx  =  0  (122) 

Where: 

S  €  9T™ 

To  determine  the  nonlinear  feedback  functions,  the  concept  of  Liapunov  stability  is 
used.  The  Liapunov  function  is  taken  as: 
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Asymptotic  system  stability  is  guaranteed  provided  that  V(x)  is  a  positive  definite  function, 
that  is: 

V(.x)  =  o]al  +  o2o2+...+onan  <0  (^24) 


Equation  (124)  is  satisfied  if: 


<7,  <jj  <  0  for  i  =  1  to  n 


(125) 


Equation  (125)  can  be  rewntten  as: 


c\  =-riisign(oi) 


(126) 


where  r)-t  is  a  positive  gain  parameter  for  the  ;th  sliding  surface.  Equation  (126)  can  be  rewntten 
after  substituting  the  time  derivative  of  Equation  (122)  and  Equation  (120)  as: 


S'  {Ax  +  Bu)  =  - 


T]xsign(ox) 
rj2sign(o2) 


jinsign{an)_ 


(127) 


Solving  Equation  (127)  for  u  yields: 


u  =  -(Sr B)"1  ST  Ax  -  (ST B)~] 


r\xsign(ox) 

r\2sign{o2) 


rjnsign(on) 


(128) 


Equation  (128)  can  be  rewritten  in  matrix  form  as: 

u  =  Kx  +  Ksr\sign(o) 


(129) 


w 


here: 
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K  =  -(STBy,STA 


Ks  =-(STByl 


Equation  (129)  is  identical  in  form  to  Equation  (121),  with  a  linear  state  feedback  and  a 
nonlinear  switching  term. 

For  the  decomposition  in  Equation  (128),  it  is  required  that  the  closed  loop  stability 
matrix,  (A-BK),  have  n  zero  eigenvalues.  The  sliding  surfaces  are  the  left  eigenvectors  resulting 
from  the  zero  eigenvalues. 

2.  Utkin's  method  for  MIMO  sliding  mode  control  law  design 

Determination  of  the  sliding  surfaces  can  be  difficult,  especially  with  a  MIMO  system. 
One  technique  for  this  is  proposed  by  Utkin  (1977).  For  this  technique  to  be  applied,  the  B 
matrix  of  the  state  space  system  (Equation  (120))  must  be  of  the  form: 


B  = 


(130) 


where: 


5,  eXnxn 


OeSR 


,m-n)xn 


For  the  MIMO  cases  of  vertical  plane  depth  control  used  in  this  thesis,  this  was  the  case.  For 
the  stern  planes  only  control  examples,  a  QR  factorization  was  applied,  to  transform  the  state 
space  system  into  this  form. 

Given  that  the  B  matrix  is  of  the  form  defined  in  Equation  (130),  Equation  (120)  can 
be  decomposed  into  the  following: 

x,  =  Anxx  +  A]2x2  +  Bxu  (131) 

x2  =  A2xxx  +  A22x2  (132) 


69 


where: 


x,  e  9T" 


jc2  g  <R{m-n)x] 


Au  er 


a12  g  9rt(,"-',) 


A21  g  9*<ra-"^ 


A        g  CJ^(»>-fl)jr(m-»i) 


The  sliding  surfaces  become: 


T  T 

(7  =  5,  xt  +  S2x2  -  0 


(133) 


where: 


5,r  g  ST*" 


5[  g  gT^"'-"' 


Because  the  sliding  surfaces  are  the  left  eigenvectors  of  the  n  zero  eigenvalues,  5,rcan 
be  set  to  the  identity  matrix  without  loss  of  generality.  Substitution  of  Equation  (133)  into 
Equation  (148)  leads  to: 

o  =  -v,  +  S2Tx2  =  -rjsign^  +  S2rx2 )  (1 34) 


=  -B;1[(Au  +  S2TA2l)x]  +{An+S2TA22)x2]-B\ 


l\sign(<?\) 
rj2sign(o2) 


TlnsiSn{°n) 


(135) 
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When  the  system  is  on  the  sliding  surfaces,  Equation  (133)  can  be  used  to  solve  for  x] 
in  terms  of  x2 ,  resulting  in: 

x,=ST2x2  (136) 

Substitution  of  this  result  into  Equation  (132)  results  in: 

x2  =  (A22-AnS2T)x2  (137) 

Equation  (137)  is  the  set  of  independent  equations  that  the  non  zero  eigenvalues  for 
the  control  result  from.  For  the  application  of  pole  placement  algorithms  to  determine  the 
sliding  surfaces,  it  only  has  to  be  recognized  that  it  is  in  the  standard  state  space  format: 

y  =  Ay  +  My  (138) 


with: 


A  = 

A22 

B  = 

-A2i 

k  = 

-  ST 

Once  S2  is  determined,  the  control  law  can  be  determined  by  substituting  it  into  Equation 

(135). 

Utkin's  technique  also  allows  for  the  use  of  linear  quadratic  regulator  methods  for 
determination  of  the  sliding  surfaces.  (Utkin  1977)   For  this  method,  it  is  desired  to  minimize  a 
quadratic  performance  index: 


17   -r  (139) 

I=-\xTQxdt  V       ; 


71 


where  Q  is  a  positive  definite  weighting  matrix.  By  partitioning^  in  the  same  manner  as  A 
was  partitioned  for  equations  (131)and  (132),  Equation  (139)  can  be  rewritten  as: 


I=TJ(-hTQU-h  +  *2r22]*l  +*ir2]2-*2  +  X2TQ22X2)dt 


2o 


or: 


l=-\{x2TQ'x2+vTQuvT)dt 


2o 


where: 


Q*  =  Q22-Q2\QuQn 


A    -  A22     A2lQu  Q\2 


v  =  *i  +  QulQ]2x] 


(140) 


(141) 


With  the  system  on  the  sliding  surfaces,  Equation  (140)  can  be  rewritten  as: 

x2=A*x2+A2]v  (142) 

Equations  (141)  and  (142)  are  in  a  recognizable  form  for  the  application  of  any 
convenient  linear  quadratic  regulator  solution.  The  Hamiltonian  is: 


H  =  pT(Ax2  +  A2lv)-^(x2TQ'x2  +  vTQuv)  (143) 


The  algebraic  Riccati  equation  is: 
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(A*)Tk  +  kA*-kA2lQ;llA£k  +  Q*=0  (144) 

The  solution  of  Equation  (144)  results  in: 

v  =  -Qu[A^kx2  (145) 

This  result  is  used  with  the  definition  for  v  from  Equation  (141)  to  provide  the  relationship 
between  x\  and  X2.  This  results  in  the  sliding  surface: 

Sl=Qu{Qx2+Alxk)  (146) 

With  Si  determined,  the  control  law  can  be  determined  by  substitution  into  Equation  (135). 

This  sliding  mode  LQR  controller  design  was  implemented  in  a  MATLAB®  function 
SMLQR.M  which  included  provisions  for  a  QR  factorization  for  the  cases  when  the  B  matrix 
was  not  of  the  form  given  by  Equation  (130).  SMLQR.M  is  included  in  Appendix  A. 

3.  Control  of  chatter 

One  undesirable  aspect  of  sliding  mode  control  is  the  chatter  induced  by  the  nonlinear 
switching  term  near  the  sliding  surfaces.  The  nonlinear  switching  term  in  the  sliding  mode 
control  can  cause  control  chatter  when  the  system  is  near  a  sliding  surface.  One  way  to  reduce 
the  chatter  is  to  use  the  concept  of  a  boundary  layer  around  the  sliding  surface.  First,  a  satsign 
function  is  defined: 


satsign(x)  =  < 


U>1  (147) 

x,-1<jc<1 
-l,x<-l 


A  boundary  layer  of  thickness  <p  around  each  sliding  surface,  is  applied  using  the  satsign 
function: 
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(7,  =  sat  sign 


(c  ^ 


\r,  J 


(148) 


Equation  (147)  can  be  used  to  replace  the  sign  function  used  in  Equation  (129)  with  no  change 
in  the  asymptotic  stability  of  the  system.  There  are  some  effects,  however,  because  the 
dynamics  near  the  sliding  surface  are  not  the  same  as  the  closed  loop  dynamics  which  exist 
when  the  system  is  on  the  sliding  surface.  The  final  control  law  is: 


u  =  Kx  +  K^.rjsatsign 


V 


vvy 


(149) 
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Figure  27.  SIMULINK®  model  sliding  mode  controller 


Equation  (149)  was  implemented  as  a  SIMULINK®  model,  shown  in  Figure  27. 


B.  SIMO  SLIDING  MODE  CONTROL  RESPONSE  TO  DISTURBANCES 

When  applied  to  vertical  plane  submanne  control,  sliding  mode  control  has  several 
nuances  which  are  not  obvious  from  inspection  of  the  governing  equations.  In  order  to 
illustrate  these,   the  performance  of  sliding  mode  control  will  be  explored  through  several 
example  cases.  To  keep  the  analytic  derivations  simple,  the  cases  worked  will  be  done  with 
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stern  planes  control  only.  The  general  concepts,  however,  will  be  applicable  to  stern  and  bow 

planes  control. 

The  response  of  sliding  mode  control  to  force  and  moment  disturbances  is 

fundamental  to  its  application  to  submarine  control  in  the  vertical  plane.  These  force  and 

moment  disturbances  could  result  from  a  variety  of  situations.  Examples  of  these  include  out 

of  trim  conditions,  free  surface  effects,  and  wave  forces. 

1.  Basic  sliding  mode  disturbance  response 

The  first  case  will  use  a  basic  sliding  mode  control  law,  that  is  one  without  a 

feedforward  term  or  integral  control.  The  resulting  control  law  is: 

a  =  Slw  +  S2q  +  Sie  +  S4z  (150) 

a  (151) 

S  =  K}  w  +  K2q  +  Kye  +  r\Kssatsign(—) 

H<<5_  (152) 

a)  Linear  analysis  steady  state 

Assuming  that  the  sliding  mode  control  is  not  saturated  and  that  the  control 
deflection  is  less  than  the  maximum,  the  submarine  should  reach  an  equilibrium  state  under  the 
action  of  steady  force  and  or  moment  disturbances.  The  linear  equations  of  motion  in  the 
vertical  plane  with  one  control  are: 

vv  =  a}iuw  +  al2uq  +  aXT,6  +  b]u  5  +  Fd  (153) 

q  =  a2iuw  +  a22uq  +  a2?i9  +  b2u  8+Md  (154) 

6  =  q  (155) 

z  =  w-u0  (156) 

x  =  w6  +  u  (157) 

Equations  (150)  through  (157)  can  be  solved  for  the  following  steady  state  condition: 
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Fd(-ub2)+Md{ubx) 

/    — 

b2auu    +  b2al3-  bla2lu    -bla2} 


Qss=0 


0..  =■ 


Fd(-b2)  +  Md(b,) 


-M. 


b2auu   +b2ali-b]a2lu   -bxa23 

a2iu2  +  K3u2b2  +a23  +  u*riK:.<pb2Sl  +  u27]Ks(f>b2S3  +  AT,  w  3Z?2 

it  KnS4<p(b2auu   +b2ali-bla2lu2  -b\a23) 

K3u2bl  +  anu2  +an  +  u37]Ks$blSl  +  K]uibl  +  u2rjK^biS3 
u  KnSi<p(b2auu   +  b2al3-bta2lu*  -b^a23) 

s    _  Fd(a2lu2  +a23)+Md(-al]u2  -al3) 
u  (b2auii2  +b2an-bla:nu2  -b\a23) 


(158) 

(159) 
(160) 

(161) 


(162) 


If  the  sliding  mode  is  just  saturated,  that  is    \a  1 0|  =  1 ,  the  system  will  still  be 
stable,  however  the  gain  parameter  7]  will  be  at  a  critical  value.  If  further  reduced,  the  system 
will  be  unstable.  Assuming  the  sliding  mode  is  just  saturated  this  critical  value,  T\cn! ,  can  be 
determined. 


ncril  = 


F, 


a2lu2  +a23  +  K3u2b2  +  A^,«3i»2 
Ksu2{b2auu2  +b2au  -b^a2Xu2  -bxa23) 


-M. 


,u2  +a,,  +  K,u2b,  +  K,u*b 


13    r  Jv3"    u\    '    "I"    u\ 


Ksu2(b2auu2  +b2a[3  -bxa2Xu2  -b^a23) 


(163) 


For  cases  with  the  gain  parameter  77  less  than  critical,  a  steady  state  z  results, 
along  with  steady  state  values  in  all  states  other  than  z  .    By  assuming  a  steady  state  z  and 
solving  Equations  (150)  through  (157)   for  equilibrium,  the  following  equations  result: 


e„  = 


Fj(-a2]  - b2uKt)  +  MdifruK}  +  au)  +  u  KsT](b2au  -b^a2X) 
u2K^(b]a2]  -b2au)  +  uK](anb2  -anbx)  + a]3a2]  ~a23a]\ 


Z.v.v  = 


Fd  +blu2  Ksrj  +  e„(a]3  +auu2  +b]u^K]  +b]u2K3) 


u(b,uK,  +  au ) 


(164) 
(165) 
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w„=u0„  +  z„  (166) 

q„=0  (167) 

=  -(fl,,t<wv<+a,30,,  +  ft/)  (168) 

°v.v  2 

Inspection  of  Equation  (164)  may  cause  the  reader  to  incorrectly  assume  that  a 
nonzero  steady  state  value  of  0  will  exist  in  the  absence  of  disturbances.  This  is  not  the  case, 
however,  because  the  use  of  Equation  (164)  implies  the  lack  of  a  steady  state  z  ,  and  therefore 
a  disturbance. 

b)         Nonlinear  analysis  steady  state 

An  analysis  similar  to  that  conducted  on  the  linear  equations  can  be  conducted 
to  determine  the  system  steady  state  response  under  a  constant  disturbance.  The  nonlinear 
equations  of  motion  in  the  vertical  plane  with  one  control  are: 

w  =  auuw  +  anuq  +a]jsin(9)+b]u  8+  Fd  cos(0)  +  euq~  +  e]2qw  (169) 

q  =  a2]uw  +  a22uq  +  a2isin(d)+b2u28  +  Md  cos(0)  +  e2lq2  +  e22qw  (170) 

6  =  q  (171) 

z  =  wcos(0)-Msin(0)  (172) 

i  =  wsin(0)  +  Kcos(0)  (173) 

Once  again,  the  basic  sliding  mode  control  of  Equations  (150)  and  (151)  is 
used.  Assuming  that  steady  state  is  possible  (sliding  mode  control  is  not  saturated,  and  the 
control  deflection  is  less  than  the  maximum)  Equations  (169)  through  (173)  subject  to  the  basic 
sliding  mode  control  law  can  be  reduced  to  the  following  nonlinear  equation: 

aus\n(9)u2b2+  ax 3  sin(0)  cos(0)62  + /^  cos2  (6)b2  -  (174) 

b\a2l  sin(0)«2  -  £>,fl23  sin(0)  cos(0)  -  fc,  Md  cos2 (0)  =  0 
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Solution  of  Equation  (174)  yields  the  steady  state  value  of  0  .  It  is  of  note  that 
Equation  (174)  is  independent  of  the  control  law.  The  correct  root  is  readily  determined  by 
using  the  value  closest  to  the  linear  analysis  (Equation  (160)).    Substitution  of  this  value  into 
Equations  (169)  through  (173)  yields  following  steady  state  results: 

wu=wtan(0vJ  (175) 

?,,=0  (176) 


5    =  -(a^uw^+a^siniej+Fj)  (177) 

b,u2 

-^-(5   -K.w    -K,0.)-S.w..-S,0..  ^       ' 

T)KS     "        '    "        3  "         '    "        3  " 


S< 


The  steady  state  value  of  z  given  by  Equation  (178)  is  dependent  upon  the 
control  law  gains.  Following  the  example  of  the  linear  analysis,  a  critical  value  of  the  gain 
parameter,  r\cnt  can  be  determined. 


Tier 


8ss-KlWss-K3e,s 


K, 


(179) 


Unlike  the  linear  analysis,  the  critical  value  of  the  gain  parameter  is  not  just  a 
linear  combination  of  the  disturbance  forces,  but  rather  requires  nonlinear  solution  for  each 
possible  case. 

If  \a  I  <j)\  >  1  the  sliding  mode  control  will  be  saturated,  and  a  nonzero  steady 

state  z„  will  exist.  For  this  case,  the  control  law  control  law  reduces  to: 

5-  Kxw+K2q  +  Kj,G  +  i]Kssign{o)  (180) 

Given  the  steady  state  final  condition  in  all  state  variables  with  the  exception  of 
z,  Equations  (169)  through  (173)  and  (180)  can  be  reduced  to  finding  a  root  of  the  following 
nonlinear  equation: 
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u   {b^K^ijfi  +  blKna2i  -b2K?iau6  -b2K2au)  +  usin(6)(ai?ib2Kl  ~a2?,b\K\) 

b2uKx  +  all 
Fd  cos(9)(b2uK\  +a2l)-  M d  cos(0)(bluK]  +«,,)  +  sm(9)(al?ia2l  -a23ai\) 


(181) 


b2uKi  +  a2i 


=  0 


This  can  be  accomplished  using  the  using  the  linear  value  of  0T,  from  Equation  (164)  as  the 
initial  guess.  It  follows  that: 


z« 


Fj  cos  (a„)  +  q,3  sin(fl„)cos(0„) 
u{b\iiK\  +«ii ) 

u2(fl,,  sin(0,,)  + £,»£,  sin(g,t)  +  fei/r30„  cos(0,t  )  +  £,£,  77  cos(0„)) 
u{bxuK\  +au) 

w„  =  w  tan(0„ )  +  z„ 

5„  =  ^,iv„  +  Kj9s,+riKssign(o) 


(182) 


(183) 
(184) 


c^  Disturbance  response  simulation  with  basic  sliding  mode 

These  results  can  then  be  applied  to  the  SUBOFF  hydrodynamic  coefficients. 
For  the  modified  coefficients  used  in  this  thesis,  the  linear  state  space  system  at  six  knots  with 
stern  planes  only  is: 


"-0.0179      3.7101  0.0196  0 

0.0006  -0.0680  -0.0034  0 

0  1  0  0 

1  0  -10.1269  0 


w 

"-0.1009^ 

\Fj] 

q 

-.0027 

M, 

6 

+ 

0 

6  + 

0 

z_ 

0 

0 

(185) 


A  sliding  mode  control  law  is  determined  using  Utkin's  method.  After  some 
experimentation,  the  diagonal  of  the  minimization  matrix  Q  was  selected  as  Qn  =  100,  Q22  = 
100,  Q33  =  100,  Q44  —  1.  This  yielded  the  following  control  law: 


a  =  l.Ow  -  67:5592;/  -  1 5.40820  +  0.0830z 


(186) 
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5  =  -0.2803w  +  84.8572<7  +  7.06 1 20  +  Ksr\satsign 

\8\  <  0.4 


*V 


\v  J 


(187) 
(188) 


A  moment  disturbance  was  chosen  to  be  controllable  but  give  a  nontrivial 
response.  The  application  of  a  force  of  five  thousand  pounds  and  moment  of  4,573  thousand 
foot  pounds  resulted  in  a  pure  angular  acceleration  ,  Md  -  0.001  radians/second2.  For  this  state 
space  system,  control  law,  and  disturbance  set,  the  value  oir\cril  was  (0.0661).  Application  of 
the  nonlinear  solutions  yielded  the  steady  state  solutions  in  Table  13. 


1    'In, 

wtl{Feet  1  Sec) 

q„{Rad  /sec) 

d  ^(Degrees) 

z„(Feet) 

S„  ( Radians) 

z„(Feet 1  Sec) 

0 

-0.9606 

0 

-0.8271 

Infinity 

0.1673 

-0.8143 

0.5 

-1.1791 

0 

-4.3402 

Infinity 

0.1941 

-0.4094 

1.1 

-1.3965 

0 

-7.8518 

-19.5783 

0.2208 

0 

2 

-1.3965 

0 

-7.8518 

-14.6467 

0.2208 

0 

4 

-1.3965 

0 

-7.8518 

-11.6330 

0.2208 

0 

Table  13.   Steady  state  nonlinear  solutions  for  Md  =0.001  radians/second2 

The  system  transient  response  was  simulated  using  the  RK45  function  of  the 
SIMULINK®  toolbox.  Figure  28  shows  the  resulting  paths.  The  response  is  given  for  six 
values  of  the  ratio  of  r\  and  r/m, .  As  expected,  for  values  of  r\  less  than  critical  the  control 
law  is  unable  to  maintain  a  steady  depth. 
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Figure  28.  Nonlinear  simulation  of  vertical  plane  response  to  a  pure  moment  disturbance 


The  calculations  and  simulations  were  repeated  for  a  pure  force  disturbance.  A 
force  of  43  thousand  pounds  and  a  moment  of  220.4  foot  thousand  pounds  resulted  in  a  pure 
vertical  acceleration  of  0.005  feet/second2.  For  this  state  space  system,  control  law,  and 
disturbance  set,  the  value  of  T)crit  was  (0.0466). 


1)  'Tlcn, 

wu{Feet  1  Sec 

qti{Rad  1  sec) 

8tl(Degrees) 

zu(Feet) 

S  „(  Radians) 

itl(Feet  1  Sec) 

0 

1.5724 

0 

5.4888 

Infinity 

0.2357 

0.5966 

0.5 

1.4156 

0 

2.9632 

Infinity 

0.2549 

0.8902 

1.1 

1.8836 

0 

10.5368 

22.4107 

0.1976 

0 

2 

1.8836 

0 

10.5368 

17.4792 

0.1976 

0 

4 

1.8836 

0 

10.5368 

14.4654 

0.1976 

0 

Table  14.  Steady  state  nonlinear  solutions  for  Fd  =0.05 
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Figure  29.  Nonlinear  simulation  of  vertical  plane  response  to  a  pure  force  disturbance 


d)  Disturbance  response  with  sliding  mode  feedforward  control 

To  eliminate  the  steady  state  error  induced  by  a  disturbance,  several  techniques 
may  be  employed.  Using  a  feedforward  function  in  the  sliding  mode  control  law  is  one 
technique.  A  feedforward  term  works  by  using  knowledge  of  the  external  disturbance  and 
using  applying  some  degree  of  control  effort.  This  provides  a  steady  state  control  effort  to 
oppose  the  disturbance  without  a  steady  state  error.  This  approach  is  limited  as  it  requires  one 
control  per  zero  error  state  and  may  be  limited  in  other  ways.  A  feedforward  term  can  be 
added  to  the  sliding  mode  control  law  by  changing  the  sliding  surface  to  the  following: 


<T  =  S,w  +  S2g  +  S3e  +  S4  z  +  S5 


(189) 


The  value  of  55  is  such  that  it  will  equal  the  control  effort  that  is  applied  by  the 
steady  state  quantity  that  is  desired  to  be  zeroed.  Since  the  main  priority  is  to  obtain  zero 
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depth  error,  S5  is  selected  to  equal  the  control  effort  introduced  by  the  previously  calculated 
value  of  steady  state  depth  error: 


S,  =-L- (5, .-K.w    -K,0   )-S.w.  -5,0, 


(190) 


The  steady  state  values  needed  for  Equation  (190)  can  be  determined  from 
linear  or  nonlinear  analysis,  although  the  linear  analysis  will  result  in  a  non-zero  depth  error. 
The  linear  analysis  gives  the  following: 


S5  =  C]MJ+C2FJ 


(191) 


where: 


C, 


°i3  vr    i        S-fa      Stub, 


54*M  "  '   u2 


'4    ; 


auu  b2+aiTlb2 -bla2]u    -b,a23 


C,= 


54AT,ij 


a2l  +  -f  +  K}b2  +  Kxub2    +  -"■  + 


53&2        5]M^2 


S4 


an«  62  +  an^2  ~b]a2]u    -bxa27l 


(192) 


(193) 
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Figure  30.   Nonlinear  simulation  of  vertical  plane  response  to  a  pure  moment 
disturbance  with  a  feedforward  term  based  on  nonlinear  steady  state 
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Figure  31.   Nonlinear  simulation  of  vertical  plane  response  to  a  pure  force  disturbance  with 
a  feedforward  term  based  on  nonlinear  steady  state 

e)  Disturbance  response  with  sliding  mode  integral  control 

Another  means  of  eliminating  steady  state  error  is  by  the  use  of  an  integral 
control  term.  To  accomplish  this,  an  additional  equation  is  added  to  the  state  space 
representation. 

Z,=Z  (194) 


This  forces  a  zero  steady  state  error  in  z  ,  although  there  are  some  additional 
considerations  with  the  use  of  integral  control.  The  resulting  control  law,  with  the  additional 
state,  is: 

o  =  Slw  +  S2q  +  Si0  +  S4z  +  S5z,  (195) 


o 


8  =  K\\v+  K2q  +  K}6  +  K4z  +  T]Kssatsign(—) 


(196) 
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\S\  <  0.4 


(197) 


Based  on  inspection  of  Equations  (195)  and  (196)  several  conclusions  can  be 
drawn.  First,  because  z  is  included  in  the  proportional  portion  of  the  control  law,  values  of  the 
gain  parameter  which  are  less  than  critical  will  result  in  a  steady  state  error  in  z  for  any 
controllable  disturbance.  Second,  if  there  is  a  steady  state  error  in  z  ,  the  magnitude  of  the 
integral  term,  z,  ,  will  tend  to  infinity.  This  can  cause  problems  with  changing  conditions  or 
pathkeeping  as  it  will  delay  the  control  response  to  other  errors. 

At  a  condition  of  steady  state,  with  the  gain  parameter  greater  than  critical,  the 
steady  state  error  in  z  is  zero.  Because  of  this,  the  previously  calculated  values  for  steady  state 
pitch  angle,  heave,  and  control  deflection  are  still  valid  (Equations  (174)  through  (177)). 
Moreover,  because  any  controllable  disturbance  will  result  in  a  steady  state  condition  these 
values  apply  for  cases  where  the  gain  parameter  is  less  than  critical. 

For  conditions  where  the  gain  parameter  is  less  than  critical,  the  resulting 
control  law  is: 

<5  =  K}w  +  K2q  +  K^6  +  K4z  +  7iKssign(o)  (198) 


And  the  steady  state  value  of  z  is: 


Z.V.V 


Ssx-K]Wxs-K,e„-riKssign{a) 
K4 


(199) 


Expressed  in  linear  state  space  form  for  control  law  design,  the  representation 
for  the  SUBOFF  at  six  knots  is: 


-0.0179  3.7101  0.0196  0    0 

0.0006  -0.068  -0.0034  0    0 

0  1                0  0    0 

1  0  -10.1269  0    0 
0               0                0  10 


w 

"- 0.1 009" 

~Fi' 

q 

-  0.0027 

Mj 

9 

+ 

0 

<5  + 

0 

z 

0 

0 

lzi. 

0 

0 

(200) 
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Utkin's  method  was  applied  to  obtain  a  suitable  control  law.  After  some 
experimentation,  the  diagonal  of  the  minimization  matrix  Q  was  selected  as  Qn  =  100,  Q22  = 
100,  Q33  =  100,  Q«  =  1,  Q55  =  0.01.  This  yielded  the  following  control  law: 

a  =  l.Ow -49.8158*7 -12.77250  + 0.1 050z  +  0.0035z,  (201) 

r0\  (202) 


V  v  j 


5  =  - 1.6009 w  +  161.0589^  +  24.8 1250  -  0.099  lz  +  Ksr\satsign 

\8\  <  0.4  (203) 

Simulations  of  the  SUBOFF  under  sliding  mode  integral  control  with  a 
moment  disturbance  are  given  in  Figure  32.  For  this  state  space  system,  control  law,  and 
disturbance  set  the  value  of  i}eri,  was  (0.0484).  Shown  are  five  different  values  the  ratio  of  the 
gain  parameter  to  the  critical  gain  parameter.  For  values  of  the  ratio  larger  than  about  two,  the 
system  exhibited  excessive  oscillation  before  settling  to  zero  depth  error. 

Simulations  of  the  SUBOFF  under  sliding  mode  integral  control  with  a  force 
disturbance  are  given  in  Figure  33.  For  this  state  space  system,  control  law,  and  disturbance  set 
the  value  o£r)cril  was  (0.0466).  Shown  are  six  different  values  the  ratio  of  the  gain  parameter  to 
the  critical  gain  parameter.  For  values  of  the  ratio  larger  than  about  two,  the  system  exhibited 
excessive  oscillation  before  settling  to  zero  depth  error. 

f)  Sliding  mode  disturbance  response  conclusions 

Submarine  vertical  plane  depth  control  using  sliding  mode  control  can  be 
effectively  achieved  in  the  presence  of  disturbances.  Sliding  mode  control  is  similar  to  linear 
state  feedback  in  that  the  an  external  disturbance  will  result  in  a  steady  state  depth  error. 
However,  if  the  gain  parameters  of  the  sliding  mode  control  are  not  properly  selected,  a  loss  of 
depth  control  can  occur. 

Steady  state  error  can  be  dealt  with  using  feedforward  or  integral  control. 
Integral  control  has  several  advantages.  Application  of  integral  control  does  not  require 
knowledge  of  the  disturbance.   However,  if  the  gain  parameter  is  too  small,  windup  of  the 
integral  term  occurs.  If  the  gain  parameter  is  too  large,  excessive  oscillations  can  be 
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introduced.  The  greatest  advantage  of  integral  control  demonstrated  was  that  gain  parameters 
less  than  critical  did  not  result  in  loss  of  depth  stability. 
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Figure  32.   Nonlinear  simulation  of  moment  disturbance  using  sliding  mode  integral 

control 


Feedforward  control  exhibited  good  disturbance  compensation,  assuming  that 
the  disturbances  were  measurable.   Given  the  disturbances,  feedforward  values  can  be 
determined  based  upon  the  nonlinear  equations  of  motion,  requiring  periodic  nonlinear  root 
finding,  or  upon  the  linear  solution.  Because  of  the  computational  expense  of  obtaining  the 
nonlinear  solution  and  the  expected  error  in  the  hydrodynamic  coefficients,  a  linear  steady  state 
solution  is  appropriate  for  feedforward  computation. 
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Figure  33.  Nonlinear  simulation  of  force  disturbance  using  sliding  mode  integral  control 


C.  MIMO  SLIDING  MODE  CONTROL  AT  PERISCOPE  DEPTH 

1.  Introduction 

The  purpose  of  using  sliding  mode  control  was  to  provide  an  alternate  means  of 
control  which  relied  upon  all  the  system  states.  The  robust  characteristics  of  sliding  mode 
control  were  thought  to  be  a  good  approximation  to  the  human  operators. 

At  periscope  depth,  experience  dictates  several  desired  conditions.  First,  the  ship  is 
trimmed  heavy  to  counter  the  steady  wave  forces.  Even  more  weight  is  brought  on  after  this 
point  to  allow  for  a  constant  small  positive  trim  angle,  of  several  degrees.  This  provides 
reserve  ballast  which  is  made  available  by  reducing  the  trim  angle.   Finally,  in  sea  state  three,  it 
should  be  very  possible  to  maintain  depth  within  one  foot  of  ordered  depth. 
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The  equations  of  motion  used  for  this  section  are  the  nonlinear  equations  of  submarine 
motion  in  the  vertical  plane.  They  are  different  from  the  equations  used  previously  in  this 
chapter,  as  they  include  both  bow  and  stern  planes.  Also  the  force  and  moment  disturbances 
used  represent  not  only  constant  disturbances,  like  ships  trim,  but  time  varying  wave  forces  as 
well.  Repeated  for  convenience,  the  equations  are: 


vv  =  auuw  +  anuq  +a]3  sin(0)  +  buu28h  +  bnu28s  +  Fd  cos,(Q)  +  euq    +enqw 
q  =  a2]uw  +  a22uq  +  <323  sin(0)  +  b2]u28h  +  b22u28s  +  M d  cos(6>)  +  e21q    +e22qw 

e  =  q 

Z  =  wcos(d)  -  u  sin(#) 
x  =  wsin(6)  +  ucos(0) 


(204) 

(205) 

(206) 

(207) 
(208) 


2.  Basic  sliding  mode  controller 

The  sliding  mode  controller  is  of  the  same  form  as  before,  although  with  the 
introduction  of  MTMO  control  some  of  the  scalar  terms  become  vectors  or  matrices.  The 
form  of  the  basic  sliding  mode  controller  is: 


a]  =  Suw  +  S]2q  +  S]3Q  +  SH  z 


a 2  =  S2]w  +  S22q  +  S239  +  S24  z 


5h  =  Kuw+  K]2q+  K^9  +  T])Ksxxsatsign 

Ss  =  K2[w  +  K22q  +  K239  +  T]xKS2xsatsign 

N<<5max 

<5,  <  <5m!,„ 


(T, 


+  r\2K     satsign 


fo^ 


Wi  ; 


*V 


\y\  ) 


\vi  ) 


r\2K  S22satsign 


'^ 


\H>2  J 


(209) 
(210) 
(211) 

(212) 

(213) 
(214) 
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As  an  initial  attempt,  Utkin's  method  was  used  to  determine  a  sliding  mode  control 
law.  After  some  experimentation,  the  diagonal  of  the  minimization  matrix  Q  was  selected  as 
Qn  =  100,  Q22  =  100,  Q33  —  100,  Q44  =  1.  This  resulted  in  the  following  control  matrices: 


K  = 


39.6585      -632.81 
-24.6916      429.65 


-  40454     0 
250.27       0 


S  = 


1 

0 

-  00985 

0.0170 


1.7281 
-  0.0985 


(215) 
(216) 


K.  = 


10.9711     -405.06 
3.083        252.10 


(217) 


The  values  of  the  gain  and  boundary  layer  thickness  parameters  were  taken  as: 


77,  =  7]2  = 


1 


20 

0i  =  fa  =  1 


(218) 
(219) 


A  SIMULINK®  model  was  developed  to  incorporate  the  submarine  dynamics  of 
Chapter  II,  the  wave  forces  of  Chapter  III,  and  the  MIMO  sliding  mode  control  law.  Also 
included  was  the  trim  model  from  Chapter  IV. 

The  model  was  used  to  simulate  a  step  change  in  commanded  depth  from  140  feet  to 
50  feet  in  depth.  To  provide  some  realism  in  the  trim  condition,  the  submarine  was  trimmed 
to  25  thousand  pounds  heavy,  with  no  moment  correction.  Wave  force  values  for  sea  state 
three  were  used,  with  a  relative  heading  of  180  degrees  (head  seas).    Figure  35  shows  the 
resulting  path  taken  by  the  submarine. 
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Figure  34.   SIMULINK®  model  of  submarine  with  wave  forces  and  trim 

At  first  glance,  this  control  scheme  fulfills  most  of  the  desired  characteristics  of  a 
submarine  depth  controller.  Periscope  depth  was  achieved  with  no  overshoot,  and  reasonable 
depth  control  was  maintained.  The  trim  condition  was  selected  so  that  a  steady  state  positive 
trim  angle  would  exist  at  periscope  depth.  During  the  depth  change,  the  maximum  trim  angle 
achieved  was  about  ten  degrees,  which  is  also  very  consistent  with  actual  submarine  practice. 

Inspection  of  Figure  36  shows  some  problems  with  this  particular  controller.  The 
application  of  control  effort  was  excessive.  The  main  reason  for  this  was  the  high  frequency 
variations  in  w  and  q  induced  by  the  wave  forces.  Because  of  the  combination  of  wave  forces 
and  trim,  the  commanded  depth  was  not  achieved.  The  average  depth  at  periscope  depth  was 
50.75  feet,  as  opposed  to  the  commanded  depth  of  50  feet. 
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Figure  35.  Basic  sliding  mode  performance,  step  change  approach  to  PD 

Although  the  performance  for  the  sea  state  three,  head  seas  was  adequate  with  this 
controller,  it  did  not  perform  well  with  the  other  sea  states  or  headings.  Because  of  this,  it  was 
decided  to  use  this  control  as  a  starting  point  for  a  performance  optimization  for  each  of  the 
four  sea  state  and  direction  cases  available. 

As  was  done  for  state  feedback  control,  the  MATLAB®  CONSTR  function  was  used 
to  perform  the  optimizations.  To  provide  a  general  set  of  design  variables,  the  sliding  mode 
linear  quadratic  regulator  program  was  not  used  to  determine  the  control  law  at  each  step  of 
the  optimization.   Instead,  the  sliding  surface  itself  was  varied  to  change  the  control  law. 


93 


2000  4000 

x  feet 


6000 


0.5 


03 


s     o 


CD 
T3 


-0.5 


Silffi 


:* 


tell! 


ft 


i  saSH 


511 


Sta'Ew 

mm 
fc'Sffl 


Bow 
Stern 


2000  4000 

xfeet 


6000 


2000     4000 
xfeet 


2000     4000 
x  feet 


6000 


6000 


Figure  36.   State  parameters  for  basic  sliding  mode  approach  to  periscope  depth 


The  formal  optimization  statement  is: 
Minimize: 


F(S2l,S32,S4l,S42,ril,Ti2,H,F)  = 


}(z-zmean)2dt 

1^— 


(220) 


where: 


z  -  depth  ,  determined  by  nonlinear  simulation 


\{z)dt 


H  —  Ballast  added  to  center  of  buoyancy,  thousands  of  pounds 
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F  —  Ballast  shifted  from  forward  to  aft,  thousands  of  pounds 


Subject  to: 


real(eigenvalues{A22  -  ^21  ^2  ))  -  ^r 


(221) 


Deviation  from  the  mean  value  of  depth  vice  the  commanded  was  used  because  of  the 
expected  average  depth  error. 

This  approach  was  used  for  each  of  the  four  sea  state  cases.  For  sea  state  three  (head 


54.5 


55 


.2  55.5 


56 


56.5 


0.5 


500 


1000 
x  feet 


1500       2000 


500 


-0.5 


Bow 
Stern 


In' 


!«! 
in! 

'"' 
!iii 
hi! 
Mil  i 
!i(! 
in  ■ 
'n1! 


'i  i 


Mi 


t :  i"»P:  fi 


Mi' 
'iiij.^ 


1000 
x  feet 


1500       2000 


a)    0.5 


CD 
"O 


5» 


500 


1000 
x  feet 


1500       2000 


-0.5 


h-i\  <  \'  1 1\.  \  '\;  u  ,\i 

1       ■     >  1 


500 


1000 
x  feet 


1500       2000 


Figure  37.   Simuladon  with  basic  sliding  mode  control  in  sea  state  three  (head  sea  direcdon) 
seas),  the  optimized  response  is  shown  in  Figure  37.  The  results  of  the  four  optimizations  are 

shown  in  Table  1 5.   For  the  RMS  error  and  maximum  error,  the  optimized  values  are  given, 

along  with  their  percentage  of  the  initial  values.  In  all  cases,  use  of  the  optimization  resulted  in 

reduction  of  the  mean  square  depth  error  (measured  from  the  average  depth).  Reduction  of 

the  maximum  error  was  also  achieved. 
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Sea  State/Direction 

3/head 

3 /beam 

4/head 

4/beam 

Initial  Values 

S 

1 

0 

1 

0 

1 

0 

1 

0 

0 

1 

0 

1 

0 

1 

0 

1 

-0.0985 

1.7281 

-0.0985 

1.7281 

-0.1388 

1.377 

-0.0932 

1.7281 

0.0170 

-0.0985 

0.0170 

-0.0985 

0.0191 

-0.694 

0.0170 

-0.0903 

KJ 

39.658 

-24.69 

39.658 

-24.69 

27.88 

-17.34 

36.32 

-22.61 

-632.81 

429.6 

-632.81 

429.6 

-491.0 

341.0 

-632.77 

429.7 

-404.54 

250.27 

-404.54 

250.27 

-285.23 

175.8 

-370.71 

229.21 

0 

0 

0 

0 

0 

0 

0 

0 

ni  it]i 

0.05/0.05 

0.05/0.05 

0.05/0.05 

0.0445/0.0445 

H/F(103  pounds) 

20/0 

20/0 

20/0 

20/0 

Mean  Depth  (feet) 

53.46 

49.55 

52.83 

54.53 

RMS  Error  (feet) 

1.48 

3.37 

1.63 

2.75 

Maximum  Error  (feet) 

3.00 

8.03 

4.20 

9.78 

Sliding  surface 

-0.8725  +  0.5063i 

-0.8725  +  0.5063i 

-0.6981  +  0.4820i 

-0.8726  +  0.4172i 

eigenvalues 

-0.8725  -  0.5063i 

-0.8725  -  0.5063i 

-0.6981  -  0.4820i 

-0.8726  -  0.4172i 

Optimized  Values 

S 

1 

0 

1 

0 

1 

0 

1 

0 

0 

1 

0 

1 

0 

1 

0 

1 

-0.0816 

1.7244 

-0.0196 

1.884 

-0.1525 

1.3761 

-0.933 

1.7281 

0.0205 

-0.1203 

0.0037 

-0.0208 

0.0176 

-0.0759 

0.0170 

-0.0903 

KJ 

48.50 

-30.16 

8.008 

-5.124 

30.475 

-18.97 

36.322 

-22.615 

-631.1 

428.78 

-695.15 

469.2 

-490.8 

340.74 

-632.76 

429.67 

-494.0 

305.61 

-84.01 

52.11 

-311.5 

192.3 

-370.75 

229.24 

0 

0 

0 

0 

0 

0 

0 

0 

Hi  friz 

0.0488/0.0510 

0.0457/0.0457 

0.0501/0.0501 

0.0446/0.0445 

H/F(103  pounds) 

19.9/0 

19.6/0.0 

20.0/0 

20.0/0 

Mean  Depth  (feet) 

55.44 

57.61 

55.53 

54.57 

RMS  Error  (feet) 

0.27(18%) 

0.84  (25%) 

0.683  (42%) 

1.43(52%) 

Maximum  Error  (feet) 

0.77  (26%) 

2.36  (29%) 

1.92(46%) 

4.14  (42%) 

Sliding  surface 

-0.8725  +  0.6945i 

-1.7649 

-0.6968  +  0.5434i 

-0.8726  +  0.4173i 

eigenvalues 

-0.8725  -  0.6945i 

-0.1229 

-0.6968  -  0.5434i 

-0.8726-0.41731 

Table  15.   Optimized  basic  sliding  mode  control  law  results  and  performance 
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3.  Disturbance  feedforward 

The  sliding  mode  control  can  be  implemented  with  a  disturbance  feedforward  to 
correct  average  depth  error.  This  can  be  implemented  inside  or  outside  of  the  sliding  surface. 
For  this  example,  the  disturbance  feedforward  was  implemented  inside  the  sliding  surface 
calculation. 


a  =  STx  +  Sc 


(222) 


Assuming  that  neither  sliding  surface  is  saturated,  that  control  deflection  is  within 
limits,  and  using  a  linear  analysis,  the  steady  state  value  of  the  depth  error  can  be  written  as  a 
linear  combination  of  the  force  and  moment  disturbances  (Appendix  B). 


z.«.v       ^-commanded   ~  ^1  ?&  +  Q  M  d 


(223) 


To  eliminate  the  depth  error,  it  is  necessary  to  apply  the  same  amount  of  control  effort  that  the 
steady  state  error  provides  within  the  sliding  surface: 


ss  =  (z.v.v  -  zc 


ommanded 


S4] 


>42 


(224) 


This  results  in  the  following  control  law: 


V 

= 

^2^ 

J 

I 

K\2 

K22 

*13 

^23 

0 
0 

w  —  W                i    , 

commanded 

H      H commanded 

ft  —  ft 

commanded 

^       ^commanded 

+ 

AT 

AI2 

r\\  sat  sign 
r\2satsign 

Ml 

fa2] 
^2  J. 

1 

0  " 

T  ■ 

commanded 

.°2_ 

= 

0 

s3, 

1 

S32 

H       H  commanded 

ft  —  ft 

**      ^commanded 

+ 

C,54) 
C|S42 

c2s4] 

C2  S42 

A. 

_54, 

S42_ 

*-       ^-commanded 

|<?|<<5max 
where  the  force  and  moment  disturbances  are  filtered. 


(225) 


(226) 


(227) 
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The  initial  sliding  surface  and  gains  from  the  basic  sliding  mode  control  law  was  used 
as  the  starting  point  for  optimization.  The  formal  optimization  statement  is: 


f  _ 

J  v*      ^commanded  ' 


(228) 


F(SM  ,  S32  ,  54, ,  S42 ,  coa>  ,r\x,T]1,H,F)  = 


o 


'} 


Subject  to: 

real(eigenvalues(A22  -  A2152r))  <  £max  (229) 

This  approach  was  used  for  each  of  the  four  sea  state  cases.  For  sea  state  three  (head 
seas),  the  optimized  response  is  shown  in  Figure  38.  The  results  of  the  four  optimizations  are 
shown  in  Table  16.  For  the  RMS  error  and  maximum  error,  the  optimized  values  are  given, 
along  with  their  percentage  of  the  initial  values. 
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Sea  State/Direction 

3/head 

3/beam 

4/head 

4/beam 

Initial  Values 

S 

1 

0 
-0.0985 
0.0170 

0 

1 
1.7281 
-0.0985 

1 

0 
-0.0985 
0.0170 

0 

1 
1.7281 
-0.0985 

1 

0 
-0.0985 
0.0170 

0 

1 
1.7281 
-0.0985 

1 

0 
-0.0985 
0.0170 

0 

1 
1.7281 
-0.0985 

KT 

39.658 

-632.81 

-404.54 

0 

-24.69 

429.6 

250.27 

0 

39.658 

-632.81 

-404.54 

0 

-24.69 

429.6 

250.27 

0 

39.658 
-632.81 

-404.54 
0 

-24.69 

429.6 

250.27 

0 

39.658 

-632.81 

-404.54 

0 

-24.69 
429.6 

250.27 
0 

C0C()  (radians/second) 

0.25 

0.25 

0.25 

0.25 

Hi  lr]2 

0.05/0.05 

0.05/0.05 

0.05/0.05 

0.05/0.05 

H/F(103  pounds) 

20/0 

20/0 

20/0 

20/0 

Mean  Depth  (feet) 

55.28 

54.99 

55.10 

53.41 

RMS  Error  (feet) 

0.4181 

1.50 

1.01 

7.04 

Maximum  Error  (feet) 

1.225 

3.85 

3.50 

18.75 

Sliding  surface 
eigenvalues 

-0.8725  +  0.5063i 
-0.8725  -  0.5063i 

-0.8725  +  0.5063i 
-0.8725  -  0.5063i 

-0.8725  +  0.5063i 
-0.8725  -  0.5063i 

-0.8725  +  0.5063i 
-0.8725  -  0.5063i 

Optimized  Values 

: 

S 

1 

0 
-0.0981 
0.0166 

0 

1 
1.7281 
0.096 

1 

0 
-0.1255 
0.0400 

0 

1 
2.1291 
-0.0473 

1 

0 
-1.9567 
-0.0445 

0 

1 
3.8086 
-0.1476 

1 

0 
-0.1167 
-0.0155 

0 

1 
1.8775 
-0.0240 

KT 

38.67 

-632.8 

-394.5 

0 

-24.08 

429.65 

244.1 

0 

19.16 

-795.53 

-196.91 

0 

-11.70 

530.65 

118.74 

0 

58.9 

-1496.0 

-599.1 

0 

-37.3 
948.4 

377.5 
0 

9.906 

-693.54 

-95.02 

0 

-5.992 

467.3 

60.9 

0 

C0cn  (radians/ second) 

0.25 

0.350 

0.267 

0.245 

m  lr\i 

0.05/0.05 

0.0542/0.0578 

0.1853/0.0544 

0.0596/0.0548 

H/F  (103  pounds) 

20/0 

20.2/-0.1 

20.7/1.3 

20.1/0.0 

Mean  Depth  (feet) 

55.22 

55.47 

55.45 

2.00 

RMS  Error  (feet) 

0.405  (97%) 

1.22(81%) 

1.01  (100%) 

1.99(28%) 

Maximum  Error  (feet) 

1.36(111%) 

3.20  (83%) 

2.52  (72%) 

4.93  (26%) 

Sliding  surface 
eigenvalues 

-0.8723  +  0.4813i 
-0.8723-0.4813i 

-1.8706 
-0.2984 

-3.4649 
-0.2992 

-1.7409 
-0.1211 

Table  16.   Optimized  sliding  mode 


control  with  disturbance  feedforward  results  and 
performance 
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Figure  38.   Simulation  using  sliding  mode  control  with  disturbance  feedforward 
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4.  Integral  control 

The  sliding  mode  control  law  can  be  augmented  with  integral  control  on  depth  to 
remove  the  average  depth  error.  This  results  in  the  following  control  law: 


>bP 


K, 


Kn      Kn     K, 


K 2\        A  22        *^23        " 


24 


YV  —    YV  it 

commanded 

"      H  commanded 

f)  —  0 

**         commanded 

^       ^commanded 


(       \~ 

1  °\ 

12 

r\xsatsign 

K^i  J 

22  . 

r\2  satsign 

f°2) 

(230) 


CT, 


CT-, 


Tr 


1 

0 

W- 

commanded 

0 

1 

q- 

H  commanded 

^31 

032 

9- 

-  0 

commanded 

J4I 

S42 

z- 

'  commanded 

$51 

$52 

z, 

\8\*8B 


(231) 


(232) 


After  a  stable  set  of  gains  was  determined,  the  controller  was  optimized  to  minimize 
the  deviation  from  the  commanded  depth.  The  formal  optimization  statement  is: 


Minimize: 


F(Sll  -  $32  ■  $41  -  $42  .  $51  >  $52  .  ty  .  *72  •  ^.  ^)  - 


j(z-z« 


immanded 


fdt 


(233) 


Subject  to: 


real(eigenvalues{A22  —  A2] S2  ))  ^  £r 


(234) 


This  approach  was  used  for  each  of  the  four  sea  state  cases.  For  sea  state  three  (head 
seas),  the  optimized  response  is  shown  in  Figure  39.  The  results  of  the  four  optimizations  are 
shown  in  Table  17. 
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Figure  39.  Simulation  with  sliding  mode  integral  control  in  sea  state  three  (head  seas) 
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Sea  State/Direction 

3/head 

3/beam 

4/head 

4/beam 

Initial  Values 

'    .  ■      ;  : 

S 

1 

0 
-0.1038 
0.0179 
0.0005 

0 

1 
1.7582 
-0.1038 
-0.0031 

1 

0 
-0.1038 
0.0179 
0.0005 

0 

1 
1.7582 
-0.1038 
-0.0031 

1 

0 
-0.1038 

0.0179 
0.0005 

0 

1 
1.7582 
-0.1038 
-0.0031 

1 

0 
-0.1038 
0.0179 
0.0005 

0 

1 
1.7582 
-0.1038 
-0.0031 

KT 

41.79 
-645.08 
-426.14 

1.268 
0 

-26.01 

437.2 

263.63 

-0.7835 

0 

41.79 
-645.08 
-426.14 

1.268 
0 

-26.01 

437.2 

263.63 

-0.7835 

0 

41.79 
-645.08 
-426.14 

1.268 
0 

-26.01 

437.2 

263.63 

-0.7835 

0 

41.79 
-645.08 
-426.14 

1.268 
0 

-26.01 

437.2 

263.63 

-0.7835 

0 

Hi  lr)2 

0.05/0.05 

0.05/0.05 

0.025/0.025 

0.05/0.05 

H/F  (103  pounds) 

20/0 

20/0 

20/0 

20/0 

Mean  Depth  (feet) 

54.82 

54.80 

55.00 

54.73 

RMS  Error  (feet) 

0.4671 

1.47 

0.707 

13.3 

Maximum  Error  (feet) 

1.14 

4.23 

2.03 

31.62 

Sliding  surface 
eigenvalues 

-0.8722  +  0.5063i 

-0.8722  -  0.5063i 

-0.0316 

-0.8722  +  0.5063i 

-0.8722  -  0.5063i 

-0.0316 

-0.8722  +  0.5063i 

-0.8722  -  0.5063i 

-0.0316 

-0.8722  +  0.5063i 

-0.8722  -  0.5063i 

-0.0316 

Optimized  Values 

■_■'■.■-'■•■•■■.,...■ 

S 

1 

0 
-0.0106 
0.0195 
0.0002 

0 

1 
0.2485 
-0.0202 
-0.0010 

1 

0 
-0.0233 
0.0197 
0.0001 

0 

1 
0.5120 
-0.0152 
-0.0007 

1 

0 
-0.0767 
0.0118 
0.0005 

0 

1 
1.5995 
-0.0766 
-0.0031 

1 

0 

-0.1428 

0.0177 
0.0003 

0 

1 
3.7927 
-0.0624 
0.0006 

KJ 

7.931 
-32.52 
-83.24 
0.3965 
0 

-4.920 
56.91 
50.04 
-0.245 
0 

5.945 
-139.4 
-63.13 
0.271 
0 

-3.682 

123.3 

37.51 

-0.1681 

0 

30.73 
-580.47 
-314.13 

1.266 
0 

-19.18 
397.3 
194.52 
-0.783 
0 

25.0 
-1469.6 
-256.2 

0.20 
0 

-15.6 
950.0 
157.8 
0.10 
0 

Hi  111 

0.0468/0.0464 

0.0461/0.0453 

0.025/0.025 

0.0436/0.0553 

H/F  (103  pounds) 

19.6/-0.1 

19.6/0.0 

20.0/0.0 

19.4/-0.1 

Mean  Depth  (feet) 

54.98 

55.01 

55.02 

55.16 

RMS  Error  (feet) 

0.2345  (50%) 

0.713  (49%) 

0.693  (98%) 

1.47(11%) 

Maximum  Error  (feet) 

0.789  (69%) 

1.90(45%) 

1.92(95%) 

4.15(13%) 

Sliding  surface 
eigenvalues 

-0.1090  +  0.4314i 

-0.1090-0.4314i 

-0.0500 

-0.2418  +  0.2871i 

-0.2418-0.2871i 

-0.0481 

-0.7834  +  0.3260i 

-0.7834  -  0.3260i 

-0.0446 

-3.6194 
-0.1971 
0.0061 

Table  17.   Optimized  sliding  mode  integral  control  law  results  and  performance 
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D.  CONCLUDING  REMARKS 

A  comparison  between  the  quality  of  control  achieved  by  sliding  mode  control  could 
conclude  that  the  sliding  mode  control  was  inferior  to  state  feedback  control.  This  comparison 
would,  however,  neglect  the  added  benefits  of  sliding  mode  control.  The  robust  character  of 
sliding  mode  control  with  the  ability  to  provide  reliable  control  for  submarine  control  given 
uncertain  hydrodynamic  coefficients  has  been  demonstrated  for  the  NPS  autonomous 
underwater  vehicle  program  (Hawkinson,  1990). 

The  sliding  mode  optimizations  did  not  substantially  reduce  the  control  chatter  and 
attendant  high  actuation  rates.  Variations  of  the  sliding  mode  boundary  thickness  did  not 
alleviate  the  chatter. 

Table  18  gives  a  summary  of  the  RMS  error  achieved  by  each  of  the  sliding  mode 
optimizations.  For  comparison,  it  also  includes  the  full  state  feedback  results  from  Chapter  IV. 
Although  these  were  larger  than  the  corresponding  full  state  feedback  cases,  the  sliding  mode 
control  proved  to  be  much  more  robust  in  response  to  step  changes  in  commanded  depth.  The 
sliding  surface  eigenvalues  exhibited  much  more  damping  than  the  corresponding  cases  of  full 
state  feedback  control.  Also,  it  seemed  to  provide  a  more  realistic  average  pitch  angle  for 
periscope  depth  operations. 


Sea  State/Direction 

3/Head 

3/Beam 

4/Head 

4/Beam 

Control  Scheme 

>,'_    " 

Full  State 

0.037 

0.2638 

0.2683 

1.24 

Basic  sliding  mode 

0.27 

0.84 

0.683 

1.43 

Full  State  with  feedforward 

0.0928 

0.4121 

0.400 

0.792 

Sliding  mode  with  disturbance  feedforward 

0.405 

1.22 

1.01 

1.99 

Full  State  integral 

0.0414 

0.372 

0.536 

1.96 

Sliding  mode  with  integral  control 

0.2345 

0.713 

0.693 

1.47 

Table  1 8.  Optimized  RMS  error  (feet)  of  sliding  mode  control  and  full  state  feedback 
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VI.        GRAPHICAL  DISPLAY 

A.  INTRODUCTION 

In  conducting  ship  control  at  periscope  depth,  a  submarine  diving  officer  relies  on  a 
variety  of  indications,  meters,  and  some  verbal  reports  to  maintain  the  ship  within  the  required 
depth  band.   In  addition  to  the  displayed  parameters,  the  ship's  control  party  also  has  their 
inertial  reference,  or  "the  seat  of  the  pants".  It  is  perhaps  the  inertia!  reference  which 
differentiates  between  great  ship's  control  parties,  and  the  merely  adequate. 

A  submarine  diving  officer  must  track  status  of  many  ship's  systems  in  addition  to  ship 
control.  The  items  which  the  diving  officer  must  monitor  include: 

•Mast  positions 

•Proximity  of  any  portion  of  the  ship  to  broaching  (sail,  rudder,  mast  fairing) 

•Water  depth  (general  terms) 

•Ship's  relationship  to  the  submerged  operating  envelope 

•Trim 

•Speed 

•Water  density 

•Ship's  evolutions  (trash  disposal,  ventilation,  etc.) 

•Towed  array,  floating  wire  antenna 

In  many  cases,  the  tracking  tool  most  used  is  the  diving  officer's  mental  picture. 
Unfortunately,  the  ability  to  keep  a  clear  status  on  many  issues  varies  with  fatigue  and  among 
individuals.  This  chapter  gives  the  current  conditions  of  the  interface  between  the  diving 
officer  and  ship's  control,  and  proposes  a  different  display  medium  to  improve  operations. 

B.  CURRENT  DIVING  OFFICER  INTERFACE 

To  maintain  a  complete  status,  the  diving  officer  has  few  tools  at  his  disposal.  He  must 
rely  on  looking  around  at  several  different  panels  to  get  mast  status,  soundings,  and  water 
density  while  supervising  the  planesman.  If  an  unplanned  event,  for  example  broaching, 
occurs  the  only  record  for  reconstruction  is  the  memory  of  the  operators. 
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The  gauges  and  meters  used  for  ship  control,  while  designed  with  generally  appropriate 
time  constants,  are  not  adaptable  for  a  given  circumstance.  For  the  most  part,  the  same 
indications  are  used  for  high  speed  transit,  periscope  depth,  and  tactical  operations.  Figure  40 
and  Figure  41  show  some  of  the  indications  used  on  board  the  USS  Nautilus  (SSN  571). 
Although  Nautilus  is  now  a  museum,  the  design  of  submarine  ship's  control  panels  has  not 
changed  significantly. 


Figure  40.  USS  Nautilus  planes  position  indications 


Figure  41.   USS  Nautilus  pitch  angle  indication 

The  current  system  of  ship  status  display  is  very  reliable,  with  redundant  indications  for 
important  items  and  some  purely  mechanical  indicators.  It  falls  short  in  the  area  of  presenting  an 
integrated  status.  Tt  is  the  writers  opinion  that  the  display  system  degrades  the  performance  of 
the  ship's  control  party.  With  some  parameters  not  displayed  and  others  not  conditioned  for  the 


106 


ship's  operating  mode,  operation  near  the  surface  in  heavy  sea  states  is  extremely  difficult. 
Skilled  operators  rely  upon  the  existing  indications,  as  well  as  "the  seat  of  their  pants"  to 
maintain  depth.  Even  so,  it  is  a  solid  accomplishment  to  keep  from  broaching  during  extended 
periscope  depth  operations. 

liven  more  complex  are  operations  in  shallow  water.  The  proximity  to  grounding 
complicates  all  aspects  of  ship  control.  The  diving  officer  must  be  constantly  aware  of  the  water 
beneath  the  keel  available  for  casualty  recovery.  Because  nonzero  pitch  angles  will  cause  one  end 
of  the  ship  to  be  deeper  than  indicated,  this  must  also  be  accounted  for. 

C.  PROPOSED  DISPLAY 

To  incorporate  the  desired  indications  in  a  single  display,  a  radically  different  approach  is 
taken.  Rather  than  rely  on  meters  and  gauges  for  the  state  of  the  ship,  a  screen  is  used.  Figure 
42  shows  the  proposed  display.  A  crude  version  of  this  display  was  developed  using  the 
SIMULINK®  Animation  Toolbox®  (Figure  43). 


I  6.0  Kts 
70.0  Feet 


6  K  heavy 


2Kaft 


Towed  Array 


Last  Sounding 


vigure  42.   Proposed  graphical  display  of  submarine  control  status 


107 


s 


^=^=\ 


Sta»»      | 

r?9     Retell  g| 

I   j  Oo  jo  a  jl 

. 

SiroutSiori  Stopped    To  l^o38y/X$ra>(ect*.  tweet  Resell 

1 

>-■;    --          «        .-    ■<:               -      •:••-•■-.-■  ,:>,-,---.:.        ;.-.--...       ■       ->--: 

1 

Figure  43.  SIMULINK®  animation  of  depth,  pitch  angle,  and  planes  angles 

By  integrating  the  ship  status  into  one  display,  numerous  improvements  can  be 
realized.  The  relationship  of  the  submarine  to  the  bottom  and  the  surface  is  clearly  shown. 
With  the  bottom  contour  information  from  a  database,  the  diving  officer  has  a  continuous 
sense  of  the  ship's  proximity  to  grounding.  In  addition  as  sounding  data  is  obtained,  it  can  be 
displayed. 

The  use  of  a  digital  display  paradigm  allows  the  display  to  be  modified  to  support 
different  operating  modes.  Because  of  the  relationship  between  ship  control  and  safety,  the 
settings  would  be  chosen  based  on  a  commanding  officer  approved  doctrine.  This  would 
allow  the  operators  to  adjust  the  display  system  to  best  fit  needs,  and  adapt  it  to  new 
circumstances  or  missions.  Alerts  and  alarms  could  readily  added  as  the  situation  warranted. 

To  assist  the  diving  officer  in  maintaining  status  on  the  wave  forces,  several  bar  graphs 
were  added  to  show  the  net  force  that  the  ship's  angle  and  planes  were  applying  at  a  given 
time.  These  quantities  would  be  filtered  to  provide  a  relevant  average.   Provided  the  averaging 
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interval  was  appropriate,  this  would  queue  the  diving  officer  to  order  trim  changes  in  response 
to  changing  environmental  conditions. 

The  periscope  video  in  the  bottom  left  hand  corner  would  provide  critical  feedback  for 
the  dive.  This  would  make  the  scope's  position  relative  to  the  surface  apparent  (another 
indication  of  depth),  and  allow  the  diving  officer  to  be  somewhat  aware  of  the  tactical 
situation.  A  close  or  new  contact  would  prompt  the  diving  officer  to  review  mast  exposure, 
which  is  also  on  the  same  display. 

Safety  of  shallow  water  operations  would  be  enhanced  by  presenting  a  clear  picture  of 
the  ship's  relationship  to  the  bottom.  During  evasive  action,  the  ship's  control  party  and  the 
Officer  of  the  Deck  would  be  working  with  common  knowledge  of  available  water  beneath  the 
keel,  and  the  contour  ahead  of  the  ship. 

Ship's  status  could  be  recorded,  to  allow  playback  for  the  reconstruction  of  unplanned 
events.  Figure  44  shows  a  possible  data  architecture  to  support  the  display. 
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Figure  44.  Graphical  display  data  paths 

D.  CONCLUDING  REMARKS 

The  integration  of  the  pertinent  ship  parameters  in  one  display  should  yield  dramatic 
improvements  in  submarine  periscope  depth  operations.  The  diving  officers  improved 
awareness  should  reduce  fatigue  levels,  allow  for  slightly  lower  speeds  for  a  given  sea  state 
(reducing  mast  feather),  and  enable  a  much  more  complete  environmental  picture  for  the  ship's 
control  party.  This  awareness  should  increase  the  confidence  of  the  ship's  control  party  during 
demanding  shallow  water  operations,  reduce  the  likelihood  of  grounding  or  broaching,  and 
provide  an  improved  level  of  support  for  the  Officer  of  the  Deck. 
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VII.       CONCLUSIONS  AND  RECOMMENDATIONS 

A.  CONCLUSIONS 

As  additional  states  were  added  to  the  control  laws,  the  level  achieved  by  the  control 
law  optimizations  generally  improved.  For  the  full  state  feedback  control  cases,  the  depth 
control  exceeded,  in  the  authors  expenence,  what  is  achievable  by  manual  control. 

Ship's  control  parties  use  more  information  about  the  state  of  the  ship  than  is  available 
from  the  explicit  indications.  Also,  the  success  of  the  disturbance  feedforward  control  suggests 
that  averaged  net  force  and  moment  would  be  of  value  to  the  ship's  control  party. 

Sliding  mode  control  provided  well  damped  dynamics,  with  a  robust  behavior  in 
response  to  changes  in  commanded  depth.  Although  sliding  mode  control  did  not  achieve  the 
very  low  RMS  errors  of  full  state  feedback,  the  gains  which  it  employed  were  smaller  and  more 
realistic. 

B.  RECOMMENDATIONS 

Although  very  good  depthkeeping  was  achieved  with  state  feedback  control,  the 
optimization  schemes  used  resulted  in  control  surface  chatter,  and  very  high  control  surface 
rates.  To  improve  the  quality  of  the  model  and  provide  more  realistic  planesman  action 
several  features  could  be  added  to  the  control  laws  and  optimization  routines: 

•  Investigate  other  sea  states,  speeds  and  sea  directions 

•  Incorporate  control  surface  rate  limits 

•  Include  control  surface  chatter  in  the  optimization  objective  functions 

•  Use  of  Kalman  filtering  to  provide  state  estimation  and  filtering 

•  Investigate  the  use  of  depth  rate  for  feedback  control  in  place  of  heave 

The  application  of  a  new  display  system  to  an  operating  submarine  is  a  major 
undertaking.  Recommended  steps  to  find  a  new  manual  submarine  depth  control  paradigm 
are: 

•  Application  of  system  identification  techniques  to  submarine  operating  data  to 
investigate  the  nature  of  the  human  control 
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•  Trials  of  a  display  onboard  an  appropriate  submanne  and  or  a  submanne  dive  trainer 

•  Use  of  recorded  submanne  operating  data  to  provide  for  "instant  replay"  training  of 
ship's  control  personnel 
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APPENDIX  A 

All  computer  code  and  SIMULINK®  models  used  in  this  thesis  are  available  from 
Professor  Fotis  Papoulias,  Naval  Postgraduate  School.  The  computer  programs  and 
SIMULINK®  models  used  were: 

Programs: 

SUBOFF.M1-  initializes  SUBOFF  hydrodynamic  coefficients 

AXNL.M'-  performs  nonlinear  Ax+E[qq;wq]  calculation 

SMLQRAM-  determines  MIMO  sliding  mode  control  law  using  Utkin's  method  (LQR) 

WF_INI.M-  reads  wave  data  files,  processes 

WFORCE.M-  calculates  wave  forces  for  a  given  depth  and  time 

SB_INI.M-  initializes  model  variables  for  MIMO  vertical  plane  submarine  model 

SBI_INI.M-  initializes  model  variables  for  MIMO  vertical  plane  submarine  model  with  integral 

depth  control 

SB_SM.M-  calculates  MIMO  SM  control  law  from  Q  matrix 

SB_SS.M-  calculates  MIMO  SM  control  law  from  sliding  surface 

SB_SMFF.M-  determines  the  feed  forward  matrix  for  a  given  sliding  mode  control  law 

SB_PD.M-state  feedback  control  law 

SB_PDFF.M-  determines  the  feed  forward  matrix  for  a  state  feedback  control  law 

OBJ2.M  -  Objective  function  for  pitch  /  depth  feedback  optimizations 

OPT2A.M-  Optimization  program  for  OBJ2.M  and  sea  state  three  (head  seas) 

OPT2B.M-  Optimization  program  for  OBJ2.M  and  sea  state  three  (beam  seas) 

OPT2C.M-  Optimization  program  for  OBJ2.M  and  sea  state  four  (head  seas) 

OPT2D.M-  Optimization  program  for  OBJ2.M  and  sea  state  four  (beam  seas) 

OBJ2ff.M  -  Objective  function  for  pitch  /  depth  feedback  with  disturbance  feedforward 

optimizations 

OPT2FFA.M-  Optimization  program  for  OBJ2FF.M  and  sea  state  three  (head  seas) 

OPT2FFBM-  Optimization  program  for  OBJ2FF.M  and  sea  state  three  (beam  seas) 

OPT2FFC.M-  Optimization  program  for  OBJ2FF.M  and  sea  state  four  (head  seas) 


'  Given  after  list  of  programs 
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OPT2FFD.M-  Optimization  program  for  OBJ2FF.M  and  sea  state  four  (beam  seas) 

OBJ2I.M  -  Objective  function  for  pitch  /  depth  feedback  with  integral  depth  control 

optimizations 

OPT2IA.M-  Optimization  program  for  OBJ2I.M  and  sea  state  three  (head  seas) 

OPT2IB.M-  Optimization  program  for  OBJ2I.M  and  sea  state  three  (beam  seas) 

OPT2IC.M-  Optimization  program  for  OBJ2I.M  and  sea  state  four  (head  seas) 

OFT2ID.M-  Optimization  program  for  OBJ2I.M  and  sea  state  four  (beam  seas) 

OBJ3.M  -  Objective  function  for  full  state  partial  distribution  feedback  optimizations 

OFT3A.M-  Optimization  program  for  OBJ3.M  and  sea  state  three  (head  seas) 

OFT3B.M-  Optimization  program  for  OBJ3.M  and  sea  state  three  (beam  seas) 

OPT3C.M-  Optimization  program  for  OBJ3.M  and  sea  state  four  (head  seas) 

OFT3D.M-  Optimization  program  for  OBJ3.M  and  sea  state  four  (beam  seas) 

OBJ3FF.M  -  Objective  function  for  full  state  feedback  with  disturbance  feedforward 

optimizations 

OPT3FFA.M-  Optimization  program  for  OBJ3FF.M  and  sea  state  three  (head  seas) 

OPT3FFB.M-  Optimization  program  for  OBJ3FF.M  and  sea  state  three  (beam  seas) 

OPT3FFC.M-  Optimization  program  for  OBJ3FF.M  and  sea  state  four  (head  seas) 

OPT3FFD.M-  Optimization  program  for  OBJ3FF.M  and  sea  state  four  (beam  seas) 

OBJ 31. M  -  Objective  function  for  full  state  feedback  with  integral  depth  control  optimizations 

OPT31A.M-  Optimization  program  for  OBJ3I.M  and  sea  state  three  (head  seas) 

OPT3IB.M-  Optimization  program  for  OBJ3I.M  and  sea  state  three  (beam  seas) 

OPT3IC.M-  Optimization  program  for  OBJ3I.M  and  sea  state  four  (head  seas) 

OPT3ID.M-  Optimization  program  for  OBJ3I.M  and  sea  state  four  (beam  seas) 

OBJ3.M  -  Objective  function  for  full  state  feedback  optimizations 

OPT4A.M-  Optimization  program  for  OBJ4.M  and  sea  state  three  (head  seas) 

OPT4B.M-  Optimization  program  for  OBJ4.M  and  sea  state  three  (beam  seas) 

OPT4C.M-  Optimization  program  for  OBJ4.M  and  sea  state  four  (head  seas) 

OPT4D.M-  Optimization  program  for  OBJ4.M  and  sea  state  four  (beam  seas) 

OBJ4FF.M  -  Objective  function  for  full  state  partial  distribution  feedback  with  disturbance 

feedforward  optimizations 

OPT4FFA.M-  Optimization  program  for  OBJ4FF.M  and  sea  state  three  (head  seas) 

OPT4FFB.M-  Optimization  program  for  OBJ4FF.M  and  sea  state  three  (beam  seas) 
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OPT4FFC.M-  Optimization  program  for  OBJ4FF.M  and  sea  state  four  (head  seas) 
OPT4FFD.M-  Optimization  program  for  OBJ4FF.M  and  sea  state  four  (beam  seas) 
OBJ4I.M  -  Objective  function  for  full  state  partial  distribution  feedback  with  integral  depth 
control  optimizations 

OPT41A.M-  Optimization  program  for  OBJ4I.M  and  sea  state  three  (head  seas) 
OPT4IB.M-  Optimization  program  for  OBJ4I.M  and  sea  state  three  (beam  seas) 
OPT4IC.M-  Optimization  program  for  OBJ4I.M  and  sea  state  four  (head  seas) 
OPT4ID.M-  Optimization  program  for  OBJ4I.M  and  sea  state  four  (beam  seas) 
OBJ7.M  -  Objective  function  for  sliding  mode  control  optimizations 
OPT7A.M-  Optimization  program  for  OBJ7.M  and  sea  state  three  (head  seas) 
OPT7B.M-  Optimization  program  for  OBJ7.M  and  sea  state  three  (beam  seas) 
OPT7C.M-  Optimization  program  for  OBJ7.M  and  sea  state  four  (head  seas) 
OPT7D.M-  Optimization  program  for  OBJ7.M  and  sea  state  four  (beam  seas) 
OBJ7FF.M  -  Objective  function  for  sliding  mode  control  with  disturbance  feedforward 
optimizations 

OPT7FFA.M-  Optimization  program  for  OBJ7FF.M  and  sea  state  three  (head  seas) 
OPT7FFB.M-  Optimization  program  for  OBJ7FF.M  and  sea  state  three  (beam  seas) 
OPT7FFCM-  Optimization  program  for  OBJ7FF.M  and  sea  state  four  (head  seas) 
OPT7FFD.M-  Optimization  program  for  OBJ7FF.M  and  sea  state  four  (beam  seas) 
OBJ7I.M  -  Objective  function  for  sliding  mode  control  with  integral  depth  control 
optimizations 

OPT7IA.M-  Optimization  program  for  OBJ7I.M  and  sea  state  three  (head  seas) 
OPT7IB.M-  Optimization  program  for  OBJ7I.M  and  sea  state  three  (beam  seas) 
OPT7IC.M-  Optimization  program  for  OBJ7I.M  and  sea  state  four  (head  seas) 
OPT7ID.M-  Optimization  program  for  OBJ7I.M  and  sea  state  four  (beam  seas) 
OBJ7.M  -  Objective  function  for  full  state  feedback  optimizations 


Models: 

SMSW.M-  MIMO  sliding  mode  control  submarine  control  model,  with  wave  forces  and  trim 

SMSWFF.M-  Same  as  SMSW.M,  with  disturbance  feedforward 

SMT.M-  used  for  determining  steady  state  response,  does  not  return  the  x  state 

PDSW.M-  MIMO  state  feedback  control  submanne  control  model,  with  wave  forces  and  trim 
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PDSWFF.M-  Same  as  PDSW.M,  with  disturbance  feedforward 

PDT.M-  used  for  determining  steady  state  response,  does  not  return  the  x  state 

Wave  Force  Data  files: 

For  the  first  order  motions  /  second  order  forces,  each  displacement  /  force  is  given  in 
terms  of  a  complex  number. 

Wave  spectral  data  files 

[wave  frequency  (rad/sec),S((0)  Q,  amplitude  (feet),  phase  (rad)] 

SPEC_A.TXT 
SPEC_B.TXT 

SPEC_C.TXT 
SPEC_D.TXT 

First  order  motions 

[CO  (rad/ sec),  COtncounter  (rad/sec),  surge,  sway,  heavy,  pitch,  yaw,  roll] 

LMOT_A.TXT 
LMOT_B.TXT 
LMOT_C.TXT 
LMOT_D.TXT 

Second  order  forces 

[0>i  (rad/sec),  (1)2  (rad/sec),  Fs,  Fy,  F2,  Mx,  My,  M2  ] 

FORC_A.TXT 
FORC_B.TXT 
FORC_C.TXT 
FORC  D.TXT 
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SUBOFF.M 

function  [A,B,MMI,Emat,  D,WS]=suboff(U); 

%  SDV  hydrodynamic  data,  TM  231-78  page  6 

ff=2;  %fudge  factor  to  make  planes  authority  realistic  for  300  ft  sub 

g=32.2;  % 
L=300;  %feet 

p=1.94;%slug/ft^3; 


m  =0.018296*0.5*p*L"3; 

Iz  =  0.001 084*0.5*p*L/s5; 

Iy  =  0.001 08*0.5*p*L"5  ; 

mxg  =-0.127467E-4; 

W=m*g; 

zgb=l;  %  feet 

xgb=0;  %  feet 


Mqdot    =-0.000860*0.5*p*L"5; 
Mwdot    =-0.000561  *0.5*p*L^4; 
Mq       =-0.003702*0.5*p*L/M*u; 
Mw       =0.010324*0.5*p*L/N3*u; 

Mds      =-ff*0.002409*0.5*p*L"3*u"2; 
Mdb      =-Mds/4; 

Zqdot    =-0.000633*0.5*p*L"4; 
Zwdot    =-0.014529*0.5*p*L"3; 

Zq       =-0.007545*0.5*p*LA3*u; 
Zw       =-0.01 391 0*0.5*p*L^2*u; 

Zds      =-ff*0.005603*0.5*p*L"2*U"2; 
Zdb      =Zds/2; 


%  define  mass  matrix,  compute  mass  matrix  inverse 
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mm = eye  (4); 

mm(l ,  1 ) =m-Zwdot; 

mm(l  ,2)=-Zqdot; 

mm(2,l)=-Mwdot; 

mm(2,2)=Iy-Mqdot; 

A=zeros(4,4); 

A(l,l)  =  Zw; 

A(l,2)=m*U+Zq; 

A(2,l)=Mw; 

A(2,2)=Mq; 

A(2,3)=-zgb*W; 

A(3,2)=l; 

A(4,l)=l; 

A(4,3)=-U; 

B=[  Zdb  Zds;Mdb  Mds;0  0;0  0]; 

MMI=inv(mm); 

A=MMI*A; 
B=MMI*B; 
Emat=MMI(l:2,l:2)*[m*zgb,0;0,-m*zgb]; 

%  diameter  and  surface  area  calculation 

D=L/8.575; 

WS=67.651*(L/1 3.9792)^2; 
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AXNL.M 

function  ax=axnl(x) 

global  Amat  Emat 

n=max(size(x)); 

a=Amat; 
a(4,l)=Amat(4,l)*cos(x(3)); 

x(3)=sin(x(3)); 


ax=a*x; 
ax(l:2)=ax(l:2)+Emat*[x(2)^2;x(2)*x(l)]; 
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SMLQR.M 

function  [k,s,ks,e]=smlqr(a,b,q) 

%  [k,s,ks,e]=smlqr(a,b,c|)  determines  the  sliding 

%  mode  control  law  for  the  system 

%  xdotzza*x+b*u  where 

%  u=-kx-kn*satsgn(sigma)  and 

%  sigma=s*x.  q  is  a  positive  definite 

%  symmetric  weighting  matrix 

%  used  in  assigning  error  weights 

%  (LQR)  to  the  states.  Uses  Utkin's  method 

%  as  detailed  in  Hawkinson  ppl  0-1 7 


[n,m]=size(b); 

%  do  transformation  if  required 
if  norm(b(m+ 1  :n,l  :m))>epsA0.5 

[t,bl]=qr(b); 

bl=bl(l:m,l:m); 

t=f; 
else 

t=eye(n); 

bl=b(l:m,l:m); 
end 

q=t*q*t'; 
a=t*a*t'; 

qll=q(l:m,l:m); 
ql  2=q(l  :m,m+ 1  :n); 
q21  =q(m+l  :n,l  :m); 
q22=q(m+l:n,m+l:n); 

all=a(l:m,l:m); 
al  2=a(l  :m,m+ 1  :n); 
a21  =a(m+ 1  :n,l  :m); 
a22=a(m+ 1  :n,m+ 1  :n); 

as=a22-a21*inv(qll)*ql2; 
qs=q22-q21*inv(ql  l)*ql2; 

kt=are(as,a21*inv(ql  l)*(a21')  ,qs); 

c2=(inv(ql  l)*(ql2^-a21,)*kt),; 
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k=-[inv(bl)*(all+c2,*a21),inv(bl)*(al2+c2,*a22)]*t; 

s=rref([eye(m);  c2]'*t)'; 

ks=-inv(s'*b); 

e=eig([a+[bl;zeros(n-m,m)]*k*t']); 
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APPENDIX  B 

MAPLE®  Solutions 

Determination  of  MIMO  state  feedback  control  steady  state 
Determination  of  MIMO  sliding  mode  control  steady  state 
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This  maple  script  determines  the  steady  state  response  in  the  vertical  plane 
using  MIMO  state  feedback  control.   Constant  disturbances  are  assumed  and  the 
linear  equations  of  motion  applied  to  find  the  steady  state  depth  error.   It 

is  also  assumed  that  both  control  deflections  are  less  than  maximum. 

EQ1  and  EQ2  are  the  heave  and  pitch  linear  equations  of  motion 

>  EQ1  :  =  (all*w*u+al3*theta+bll*u"2*dl+bl2*u~2*d2)+Fd; 

EQ1  :=  all  wu  +  a!3Q  +  bll  u2  dl  +  bl2  u2  dl  +  Fd 

>  EQ2     :  =  (a21*w*u  +  a2  3*theta+b21*u"2*dl+b22*u"2*d2)+Md; 

EQ1  :=  a21  w  u  +  a23  6  +  b21  u2  dl  +  b22  u2  d2  +  Md 

>  readlib ( isolate) : 

>  w  : =  theta*u ; 

w  :=Q  u 

The  linear  state  feedback  laws  at  steady  state  are: 

>  dl  :=  Kll*w+K13*theta+K14*z; 

dl  :=KllQu  +  K13d  +  K14z 

>  d2  :=  K21*w+K23*theta+K14*z; 

dl  :=  K21  8  u  +  K23  9  +  K14  z 

After    the    application    of    the    control    laws,     the   equations    of    heavy   and   pitch 
become : 

>  EQ1=0; 

all  9  u2  +  a!3Q  +  bll  u2  (Kll  0  u  +  K13  6  +  K14  z)  +  b!2  u2  (K21Qu  +  K23Q  +  K14  z) 
+  Fd  =  0 

>  EQ2=0; 

a21  Qu2  +  a23Q  +  b21  u2(Kll  Qu  +  K13Q  +  K14z)  +  b22u2(K21  Qu  +  K23Q  +  K14z) 
+  Md  =  0 

Remove  z  from  EQ1  and  EQ2 

>  Fl :=coef f (collect ( expand (EQ1) , z) , z, 1) ; 

Fl  :=  b!2  u2  K14  +  bll  u2  K14 

>~  F2 :=coef f (collect (expand (EQ2)  , z )  , z , 1 )  ; 

F2  :=b22u2  K14  +  b21  u2  K14 


>    EQ3:=simplify(EQl-EQ2*Fl/F2)  ; 

EQ3  :=  {all  6  u2  b22  +  all  9  u2  b21  +  bll  u3  Kll  6  bll  +  bll  u2  K13  9  bll  +  al3  9  bll 
+  a!3  9  bll  -al3Qbll  +  Fd  bll  +  Fd  bll  -  Md  bll  -Mdbll  +  bll  u3  Kll  9  bll 
+  bll  u2  K13  0  bll  -  all  9  u2  bll  -  all  9  u2  bll  -  bll  u3  Kll  9  bll  -  bll  u2  K13  9  bl2 
-  bll  u3  Kll  Qbll  -bll  u2  K13Qbll  -al3Qbll)/(bll  +  b21) 


>    isolate (EQ3 , theta) ; 

Q  =  (-Fdb22-  Fdbll  +  Mdbll  +  Md  bll  )/(all  uL  bll  ^  all  uA  bll  +  bll  uJ  Kll  bll 

+  bll  it2  K13  bll  +  a!3  bll  +  al3  bll  -  a!3  bll  +  bll  u3  Kll  bll  +  bll  u2  K13  bll 
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-  a.21  u2  b!2  -  all  u2  bll  -  b21  u3  Kll  bl2  -  b21  u2  K13  bl2  -  b22  u3  K21  bll 
-b22u2  K23  bll  -a23  bJ2 


Find  the  steady  state  value  of  theta  by  setting  EQ3=0 

>  thetass : =coeff (collect (EQ3 , theta) , theta, 0) /coeff (collect (EQ3 , theta) , theta, 1) ; 

thetass  :=  ( Fd  b22  +  Fd  b21  -  Md  bl2  -Mdbll  )/(all  u2  b22  +  all  u2  b21 
+  bll  u3  Kll  b22  +  bll  a2  K13  b22  +  a!3  b22  +  a!3  b21  -  a23  bll  +  bl2  u3  K21  b21 
+  bl2  u2  K23  b21  -  a21  u2  bl2  -  a.21  u2  bll  -  bll  u3  Kll  bJ2  -  b21  u2  K13  bl2 
-  b22  u3  K21  bll  -  b22  u2  K23  bll  -  a23  M2 

Substitute  thetass  into  EQ1  and  solve  for  steady  state  z 

>  temp: =coef f ( collect (EQ1, z) ,z,0)/coeff(collect(EQl,z) , z, 1) ; 

all  Qu2  +  al3Q  +  bll  u2  (Kll  9  u  +  K13  9)  +  bl2  u2  (K21  Qu  +  K23Q)  +  Fd 
temp  :- 

bl2u2  K14  +  bll  u2  K14 

>  zss  : = 

>  coeff (collect ( temp, theta)  ,  theta ,  1 )  *  the tass  + coeff (collect ( temp, theta)  , theta , 0 ) 

>  ; 

zss:=(al3  +  bll  u2  (Kll  u  + K13)  +  bl2  u2  (K21  u  +  K23)  +  all  u2 
(Fdb22  +  Fdb21  -Mdbl2-  Mdbll  )/((b!2  u2  K14  +  bll  u2  K14)(all  u2  b22 

+  all  u2  b21  +  bll  i3  Kll  b22  +  bll  u2  K13  b22  +  al3  b22  +  al3  b21  -  a23  bll 
+  bl2  u3  K21  b21  +bl2u2  K23  b21  -  a21  u2  bl2-a21  u2  bll  -  b21  u3  Kll  bl2 

-  b21  u2  K13  b!2  -  b22  u3  K21  bll  -  b22  u2  K23  bll  -  a23  bl2 

Fd 

+  — 


12  u2  K14  +  bll  u2  K14 


Determine  the  coefficients  CI  and  C2  such  that  zss=Cl*Fd+C2 *Md 

>  CI :=simplify( coeff (collect (expand (zss) , Fd) , Fd, 1 ) ) ; 

CI  :=  (2  all  u2  b22  +  2  all  u2  b21  -  a21  u2  bl2  -  a21  u2  bll  -  a23  bl2  +  2  a!3  b21 

-  a23  bll  +  2  a!3  b22  +  2  bll  u3  Kll  b22  +  2  bll  u2  K13  b22  -  b21  u3  Kll  bl2 

+  2  bl2  u3  K21  b21  +  2  b!2  u2  K23  b21  -  b22  u3  K21  bll  -  b22  u2  K23  bll 

-b21  u2  K13  bl2  +  bl2u2  K23  b22  +  bll  u3  Kl  1  b21  +  b!2  u3  K21  b22  +  bll  u2  K13b21 

u2  K14(bl2  +  bU)(all  u2b22  +  all  u2  b21  +bll  u3  Kll  b22  +  bll  u2  K13  b22 

+  a!3  b22  +  a!3  b21  -  a23  bll  +  bll  u3  K21  b21  +  bl2  u2  K23  b21  -  all  u2  b!2 
-a21  a2  bll  -bll  u3  Kll  bl2-b21  u2  K13  bl2  -  b22  u3  K21  bll  -  bll  u2  K13  bll 
-a!3  bll 


>    C2 : =simpli  f y ( coeff (collect (expand ( zss )  , Md)  , Md, 1 )  )  ; 

C2  :=-(al3  +  bll  u3  Kll  +  bll  u2  Kl  3  +  bll  u3  Kll  +  bll  u2  K13  +  al  1  u2 
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all  u2  b22  +  all  u2  b21  +  bll  u3  Kl  1  b22  +  bl  1  u2  K13  b22  +  al3  b22  +  al3  b21  - 
+  b!2  u3  K21  b21  +  bl2  u2  K23  b21  -  all  u2  bll  -  all  u2  bll  -  bll  u3  Kll  bll 
-  bll  u2  K13  bll  -  bll  u3  Kll  bll  -  bll  u2  K13  bll  -  a!3  bll)  u2  K14 

Check  that  zss=Cl *Fd+C2 *Md 


>  eq6 : =simplify ( zss-Cl*Fd-C2  *Md) 


eq6  :=  0 
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This  maple  script  determines  the  steady  state  response  in  the  vertical  plane 
with  basic  MIMO  sliding  mode  control.  Constant  disturbances  are  assumed  and 
the  linear  equations  of  motion  applied  to  find  the  steady  state  depth  error. 
It  is  also  assumed  that  both  control  deflections  are  less  than  maximum  and 

that  neither  sliding  surface  is  saturated. 

EQ1  and  EQ2  are  the  heave  and  pitch  linear  equations  of  motion 

>  EQ1 : = (all*w*u+al3*theta+bll*u"2*dl+bl2*u~2*d2) +  Fd; 

EQ1  :=  all  w  a  +  a!3Q  +  bll  u2  dl  +  bl2  u2  d2  +  Fd 

>  EQ2     :  =  (a21*w*u  +  a2  3*theta+b21*u"2*dl+b2  2*u'-2*d2)  +Md; 

EQ2  :=  a21  w  u  +  a23  9  +  b21  u2  dl  +  b22  u2  d2  +  Md 

>  readlib (isolate) : 

>  w  : =  theta*u ; 

w  :=  0  u 

The  linear  state  feedback  laws  at  steady  state  are: 

>  dl  :=  Kl l*w+Kl 3* theta+Ks 11* etal* sigmal /phi 1+Ksl2*eta2* sigma2/phi2; 

r^7  7  „          _.,,_  n      Ksll  etal  sigmal      Ksl2  eta2  sigma2 
dl  .-Kll  0  u  +  K13  9  + — — + 


phil 


phi2 


>    d2     :=    K21*w+K23*theta  +  Ks21*etal*sigmal/phil  +  Ks22*eta2*sigma2/phi2 

d2  :=K21Qu  +  K23  9  +  ^lelalsigHu.1      022  etal  sigmal 


phil 


phi2 


> 

sigmal 

:=S11 

*w+S13- 

ttheta+S14*z; 
sigmal 

:=S11  e 

u  + 

S13Q 

+  S14z 

> 

sigma2 

:=S21 

"W+S231 

ttheta+S24*z; 
sigma2 

■=S2i  e 

u  + 

S23Q 

+  S24z 

After 
become 

;he  application  of  the  control  laws, 

the 

equations 

of 

heavy 

and 

pitch 

>    EQ1=0; 


all  Qu2  +  al3Q  +  bll  u2 


f 


Kll  Qu  +  K13Q  + 


Ksll  etal  (Sll  9  u  +  S13  6  +  S14  z) 


v 


phil 


+ 


Ksl2  eta2  {S21  6  u  +  S23  6  +  S24  z) 
phi2 


2 


+  b!2  u\K21§u  +  K23  9 


Ks21  etal  (Sll  6  u  +  S13  9  +  S14  z)      Ks22  eta2  (S21  0  u  +  S23  0  +  S24  z)  , 

+ — + — |  +  Fd  =  0 


phil 


phi2 


>    EQ2=0; 


,.,     2(»r,,n         ^,,n      Ksll  etal  (Sll  Qu  +  S13Q  +  S14z) 
a21  0  u    +a23  Q  +  b21  ii      Kll  Qu  +  K13Q  + ^ 


+ 


Ksl2  eta2  (S21  Qu  +  S23Q  +  S24  z) 
phi2 


phil 
+  b22uL\  K21  Qu  +  K23Q 


Ks21  etal  (Sll  9  u  +  S13  0  +  S14  z)      Ks22eta2(S21  9  u  +  S23  9  +  S24  z)  . 

H h ■ +  Md  =  U 


phil 


phi2 


Remove  z  from  EQ1  and  EQ2 


>  Fl :=coef f (collect (expand (EQ1)  , z)  ,  z,  1)  ; 
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bll  u2  Ksll  etal  S14      bll  u2  Ksll  etal  S14      bl2  u2  Ks22  eta2  S24 

Fl  := h + 

phi2  phi  J  phi2 

bll  u2  Ks21  etal  S14 

+ 

phil 

>    F2:=coeff (collect ( expand (EQ2)  ,  z)  , z, 1)  ; 

^       b21  u2  Ksl2eta2S24      bll  u2  Ksl  1  etal  SI4      b22  u2  Ks22  eta2  S24 

F2  := + + 


phil  phil  phi2 


b22  ii2  Ks21  etal  SI 4 

+ 

phil 


>    EQ3 : =simplify (EQ1-EQ2 *F1/F2 )  ; 

EQ3  :=  -  {-bll  u3  Ksll  etal  SI  I  9  b22  Ks22  eta2  S24  -  bll  u3  Kll  9  phil  b22  Ks22  eta2  S24 

-  bll  u2  Ksll  etal  S13  9  bll  Ksll  etal  S14  -  bll  u3  Ksll  etal  Sll  9  bll  Ksll  etal  S14 
-bll  u2  Ksll  etal  S13Q  bll  Ksll  etal  S14 -bll  u3  Kll  9  phil  bll  Ksll  etal  SI '4 
-bll  u2  K13  Qphil  b!2Ks22eta2S24-bll  u2  K13  9  phil  b22  Ks2l  etal  S14 

-all  Qu2  phil  bll  Ksl2  eta2  S24  -  all  Qu2  phil  bll  Ksll  etal  S14 

-all  0  u2  phil  b22  Ks22  eta2  S24  -all  §  u2  phi2  b22  Ks2l  etal  S14 

-  a!3  9  phil  bll  Ksll  etal  S14  -  al3  9  phil  bll  Ksll  etal  S14 

-  al3  9  phil  bll  Ksll  etal  S14  -  al3  9  phil  bll  Ksll  etal  SJ4 

-  bll  u3  Kll  Qphil  bll  Ksll  etal  S14  -  bll  u3  K21  9 phil  bll  Ksll  etal  S14 

-  bll  u2  K13  9  phil  bll  Ksll  etal  S14  -  bll  u2  K13  9  phil  bll  Ksll  etal  S14 

-  bll  ii3  Ksll  etal  Sll  9  bll  Ksll  etal  S14  -  bll  u2  Ksll  etal  SI 3  9  bll  Ksll  etal  S14 

-  bll  u3  Ksll  etal  Sll  9  bll  Ksll  etal  S14  -  bll  u2  Ksll  etal  S13  9  bll  Ksll  etal  S14 

-  Fdphil  bll  Ksll  etal  S14  -  Fd phil  bll  Ksll  etal  S14  -  Fd phil  b22  Ks22  eta2  S24 

-  Fdphil  b22  Ks21  etal  S14  +  a2J  9  u2  phil  bll  Ksl2  eta2  S24 

+  all  9  u2  phil  bll  Ksll  etal  S14  +  a21  9  u2  phil  bll  Ksll  etal  S14 

+  all  9  u2  phil  bll  Ksll  etal  Sl4  +  al3  Qphil  bll  Ksll  etal  S14 
+  a!3  9  phil  bll  Ksll  etal  S14  +  a!3  9  phil  bll  Ksll  etal  S14 

+  a23Qphi2  bll  Ks21  etal  S14  +  b2l  u3  Kll  Qphil  bll  Ksll  etal  S14 

+  bll  i3  Kll  9  phil  bll  Ksll  etal  S14  +  bll  u2  K13  9  phil  bll  Ksll  etal  S14 

+  bll  u2  Kl 3  Qphil  bll  Ksll  etal  Sl4  +  bll  u3  Ksll  etal  Sll  9  bll  Ksll  etal  S14 


bll  ii2  Ksll  etal  SI 3  9  bll  Ksll  etal  S14  +  bll  a3  Ksll  etal  Sll  Q  bll  Ks21  etal  S14 
bll  u2  Ksll  etal  S23  9  b!2  Ks21  etal  S14  +  b22  u3  K21  Qphil  bll  Ksll  etal  S14 


+  bll  u3  Kll  Qphil  bll  Ksll  etal  S14  +  bll  u2  K23  9  phil  bll  Ksll  etal  S14 
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+  b22  u2  K23Qphi2bll  Ksll  etal  S14  +  b22  u3  Ks21  etal  Sll  9  bl  1  Ksl2  eta2  S24 

+  b22  u2  Ks21  etal  SI  3  9  bll  Ksl2  eta2  S24  +  b22  a3  Ks22  eta2  S21  9  bll  Ksll  etal  S14 

+  b22  u2  Ks22  eta2  S23  9  bll  Ksll  etal  S14  +  Mdphil  bll  Ksl2  eta2  S24 

+  Mdphi2  bll  Ksll  etal  S14  +  Mdphil  bl2  Ks22  eta2  S24  +  Md phi2  bl2  Ks21  etal  S14)/{ 
b21  Ksl2  eta2  S24 phil  +  b21  Ksll  etal  S14 phi2  +  b22  Ks22  eta2  S24 phil 
+  b22Ks21  etal  SI 4 phi2) 

>    isolate (EQ3 , theta) ; 

9  =  (Fdphil  b21  Ksl2  eta2  S24  +  Fd phi2  b21  Ksll  etal  SI 4  +  Fd phil  b22  Ks22  eta2  S24 
+  Fdphi2  b22  Ks21  etal  SI 4  -  Mdphil  bll  Ksl2  eta2  S24  -  Md phi2  bll  Ksll  etal  S14 

-  Mdphil  bl2  Ks22  eta2  S24  -  Md phi2  bl2  Ks21  etal  SI 4) 
-bll  u3  Ksll  etal  Sll  b22  Ks22  eta2  S24  -  bll  u3  Kll  phil  b22  Ks22  eta2  S24 

-bll  u3  Ksl2  etal  S21  b22  Ks21  etal  S14  -  bll  u2  Ksl2  eta2  S23  b22  Ks21  etal  S14 
-all  u2  phil  b21  Ksl2  eta2  S24  -  bll  u2  Ksll  etal  S13  b22  Ks22  eta2  S24 

-  bll  u3  Kll  phi2  b22  Ks21  etal  S14  -  bll  u2  K13 phil  b22  Ks22  eta2  S24 

-  bll  u2  K13  phi2  b22  Ks21  etal  S14  -  al3 phi2  b21  Ksll  etal  S14 
-all  u2  phi2  b21  Ksll  etal  S14-all  u2  phil  b22  Ks22  eta2  S24 

-  all  u2  phi2  b22  Ks21  etal  S14  -  a!3  phil  b21  Ksl2  eta2  S24 

-  b!2  i2  K23  phi2  b21  Ksll  etal  S14  -  al3  phil  b22  Ks22  eta2  S24 

-  al3  phi2  b22  Ks21  etal  S14  -  bl2  u3  K21  phil  b21  Ksl2  eta2  S24 

-  bl2  u3  K21  phi2  b21  Ksll  etal  S14  -  bl2  u2  K23  phil  b21  Ksl2  eta2  S24 
+  a21  i2  phi2  bl2  Ks21  etal  S14  +  a23  phil  bll  Ksl2  eta2  S24 
+  a23  phi2  bll  Ksll  etal  S14  -  b!2  u3  Ks21  etal  Sll  b21  Ksl2  eta2  S24 

-  bl2  u2  Ks21  etal  SI 3  b21  Ksl2  eta2  S24  -  b!2  u3  Ks22  eta2  S21  b21  Ksll  etal  SI 4 

-b!2u2  Ks22eta2S23b21  Ksll  etal  S14  +  a2J  u2  phil  bll  Ksl2  eta2  S24 

+  a21  u2  phi2  bll  Ksll  etal  SI 4  +  a21  u2  phil  b!2  Ks22  eta2  S24 

+  b21  u3  Ksl2  eta2  S21  bl2  Ks21  etal  S14  +  b21  u2  Ksl2  eta2  S23  bl2  Ks21  etal  S14 

+  b22  u3  K21  phil  bll  Ksl2  eta2  S24  +  b22  a3  K21  phi2  bll  Ksll  etal  S14 
+  a23  phil  b!2  Ks22  eta2  S24  +  a23  phi2  bl2  Ks21  etal  S14 

+  b21  u3  Kll  phil  bl2  Ks22  eta2  S24  +  b21  u3  Kll  phi2  b!2  Ks21  etal  S14 

+  b21  it2  Kl 3  phil  bl2  Ks22  eta2  S24  +  b21  u2  K13  phi2  bl2  Ks21  etal  S14 

+  b21  u3  Ksll  etal  Sll  bl2  Ks22  eta2  S24  +  b21  u2  Ksll  etal  S13  b!2  Ks22  eta2  S24 

+  b22  u2  K23  phil  bll  Ksl2  eta2  S24  +  b22  u2  K23  phi2  bll  Ksll  etal  S14 
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+  b22  u3  Ksll  etal  Sll  bll  Ksl2  eta2  S24  +  b22  u2  Ks21  etal  SI  3  bll  Ksl2  eta2  S24 
+  b22  u3  Ks22  eta2  S21  bll  Ksll  etal  S14  +  b22  u2  Ks22  eta2  S23  bll  Ksll  etal  SI 4 


Find  the  steady  state  value  of  theta  by  setting  EQ3=0 

>  the t ass  :  =simplify  (coef  f  (collect  (EQ3  ,  theta)  ,  theta,  0)  /coef  f  (collect  (EQ3  ,  theta)  , 

>  theta, 1) ) ; 

thetass  :=  (Md phi2  bll  Ksll  etal  S14  +  Mdphil  bl2  Ks22  eta2  S24 
+  Mdphi2  bl2  Ks21  etal  S14  -  Fd phil  bll  Ksl2  eta2  S24  +  Mdphil  bll  Ksl2  eta2  S24 

-  Fdphil  b22  Ks22  eta2  S24  -  Fd phi2  b22  Ks21  etal  S14  -  Fd phi2  b21  Ksll  etal  S14)/{ 
-bll  u3  Ksll  etal  Sll  b22  Ks22  eta2  S24  -bll  u3  Kll  phil  b22  Ks22  eta2  S24 

-bll  u3  Ksl2  eta2  S21  b22  Ks21  etal  S14  -  bll  u2  Ksl2  eta2  S23  b22  Ks21  etal  S14 
-all  u2  phil  b21  Ksl2  eta2  S24  -  bll  a2  Ksll  etal  SI  3  b22  Ks22  eta2  S24 

-  bll  u3  Kll  phi2  b22  Ks21  etal  S14  -  bll  u2  K13  phil  b22  Ks22  eta2  S24 
-bll  u2  K13  phi2  b22  Ks21  etal  S14-al3phi2  b21  Ksll  etal  S14 
-all  u2  phi2  b21  Ksll  etal  S14  -  all  u2  phil  b22  Ks22  eta2  S24 

-  all  u2  phi2  b22  Ks21  etal  SI 4  -  a!3  phil  b21  Ksl2  eta2  S24 

-  b!2  u2  K23  phi2  b21  Ksll  etal  S14  -  al3  phil  b22  Ks22  eta2  S24 

-  al3  phi2  b22  Ks21  etal  S14  -  bl2  u3  K21  phil  b21  Ksl2  eta2  S24 

-  b!2  u3  K21  phi2  b21  Ksll  etal  S14-bl2  u2  K23  phil  bll  Ksl2  eta2  S24 
+  a21  u2  phi2  bl2  Ks21  etal  S14  +  a23  phil  bll  Ksl2  eta2  S24 

+  a23phi2  bll  Ksll  etal  S14  -  bl2  u3  Ks21  etal  Sll  b21  Ksl2  eta2  S24 

-  bll  u2  Ks21  etal  SI 3  bll  Ksll  etal  S14  -  bll  u3  Ksll  etal  Sll  bll  Ksll  etal  S14 

-  bll  u2  Ksll  etal  S13  bll  Ksll  etal  S14  +  all  u2  phil  bll  Ksll  etal  S14 
-tall  u2  phil  bll  Ksll  etal  S14  +  all  u2  phil  bll  Ksll  etal  S14 

+  bll  u3  Ksll  etal  S21  bll  Ks21  etal  S14  +  bll  u2  Ksll  etal  S13  bll  Ksll  etal  S14 

+  bll  u3  Kll  phil  bll  Ksll  etal  S14  +  bll  u3  Kll  phil  bll  Ksll  etal  S14 
+  a!3  phil  bll  Ksll  etal  S14  +  a!3  phil  bll  Ksll  etal  S14 

+  bll  u3  Kll  phil  bll  Ks22  eta2  S24  +  b21  u3  Kll  phil  bll  Ksll  etal  S14 

+  bll  u2  K13  phil  bll  Ks22  eta2  S24  +  bll    2  K13  phil  bll  Ksll  etal  S14 

+  bll  u3  Ksll  etal  Sll  bll  Ksll  etal  S14  +  bll  u2  Ksll  etal  S13  bll  Ksll  etal  S24 

+  bll  u2  K13  phil  bll  Ksll  etal  S14  +  bll  u2  K13  phil  bll  Ksll  etal  S14 

+  bll  u3  Ks21  etal  Sll  bll  Ksll  etal  S14  +  bll  u2  Ksll  etal  SI 3  bll  Ksll  etal  S24 

+  bll  u3  Ksll  etal  Sll  bll  Ksll  etal  S14  +  bll  u2  Ksll  etal  S13  bll  Ksll  etal  S14)___ 

^Substitute  thetass  into~EQl  and  solve  for  steady  state  z 
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>    temp:  =coef f (collect (EQ1, z)  , z, 0) /coef f (collect (EQ1,  z)  ,  z,  1)  ; 


/ 


tem/?  := 


all  Qu2  +  al3Q 


'      Iin         r^,0„      Kslletal  (5770^  +  5730)      Ksl2  eta2  (S21  Q  u  +  S23  0)^ 
+  bll  u    \  Kl  1  Q  u  +  K13Q  + -  + 


/;/n7 


phi2 


f 


+  bl2  u 

■)/ 


7<27  0M  +  A230  + 


7^27  em7  (577  0  u  +  573  0)      7^22  e/a2  (527  0  M  +  S23  9) 


phil 


+  Fd 


bll  u 


2(  Ksll  etal  S14      Ksl2  etal  S24 


phil 


+ 


phi2 


+  bl2  u 


J 


\ 


phi2 


Ks21  etal  SI 4      Ks22  eta2  S24 


phil 


+ 


phi2 


J 


>  zss  :  = 

>  coeff (collect ( temp, theta)  , theta, 1 ) *  the tass  + coef f (collect ( temp, theta )  , theta , 0 ) 

>  ; 


f 


zss  :- 


al3  +  bl  1  u 


2 


( 


V 


7^77  u  +  K13  + 


Ksll  etal  (Sll  u  +  S13)      Ksl2eta2(S21  u  +  S23) 


phil 


+ 


phi  2 


2 


+  bl2u\  K21  u  +  K23  + 


Ks2J  etal  {Sll  u  +  57 3)      Ks22  eta2  (527  u  +  S23) 


+ 


+  all  u2  I 


phil  phi2 

Mdphi2  bll  Ksll  etal  S14  +  Mdphil  bl2  Ks22  eta2  S24  +  Md phi2  bJ2  Ks21  etal  S14 
-  Fdphil  bll  Ksl2  eta2  S24  +  Mdphil  bll  Ksl2  eta2  S24  -  Fdphil  b22  Ks22  eta2  S24 


-  Fdphi2  b22  Ks21  etal  S14  -  Fd phi2  bll  Ksll  etal  S14 


f 


bll  u 


2  (  Ksll  etal  S14      Ksl2  eta2  S24 


phil 


+ 


phi2 


+  bllu' 


Ks21  etal  S14      Ks22  eta2  S24 


phil 


+ 


phi2 


-bll  u3  Ksll  etal  Sll  b22  Ks22  eta2  S24  -  bll  u3  Kll  phil  b22  Ks22  eta2  S24 

-  bll  u3  Ksl2  eta2  S21  b22  Ks21  etal  S14  -  bll  u2  Ksl2  eta2  S23  b22  Ks21  etal  S14 
-all  u2  phil  bll  Ksll  etal  S24- bll  u2 Ksll  etal  SI  3  b22  Ks22  eta2  S24 

-bll  u3  Kll  phil  bll  Ks21  etal  S14  -  bll  u2  K13  phil  b22  Ks22  eta2  S24 
-bll  u2  K13  phil  bll  Ksll  etal  S14  -  al3  phil  bll  Ksll  etal  S14 
-all  i2  phil  bll  Ksll  etal  SI  4 -all  u2  phil  bll  Ksll  etal  S14 
-all  u2  phil  bll  Ksll  etal  S14  -  al3  phil  bll  Ksll  etal  S14 

-  bll  u2  K13  phil  bll  Ksll  etal  S14  -  al3  phil  bll  Ks22  eta2  S24 

-  al3  phil  b22  Ks21  etal  S14  -  bll  u3  K21  phil  bll  Ksl2  eta2  S24 

-  bll  u3  Kll  phil  bll  Ksll  etal  S14  -  bll  a2  K13  phil  bll  Ksll  etal  S14 
+  all  u2  phil  bll  Ksll  etal  S14  +  a!3  phil  bll  Ksll  etal  S14 

+  a!3  phil  bll  Ksll  etal  S14-bll  u3  Ksll  etal  Sll  bll  Ksll  etal  S14 

-  bll  u2  Ksll  etal  SI 3  bll  Ksll  etal  S14  -  bll  u3  Ksll  etal  Sll  bll  Ksll  etal  S14 
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-b!2  u2  Ks22eta2S23  b21  Ksll  etal  S14  +  a21  u2 phil  bll  Ksl2  eta.2  S24 

+  a21  u2  phi2bll  Ksll  etal  S14  +  a21  u2  phil  bl2  Ks22  eta2  S24 

+  b21  u3  Ksl2  eta2  S21  bl2  Ks21  etal  S14  +  b21  u2  Ksl2  eta2  S23  b!2  Ks21  etal  S14 

+  b22  a3  K21  phil  bll  Ksl2  eta2  S24  +  b22  u3  K21  phi2  bll  Ksll  etal  S14 
+  a23  phil  b!2  Ks22  eta2  S24  +  a23  phi2  b!2  Ks21  etal  S14 

+  b21  a3  Kll  phil  bl2  Ks22  eta2  S24  +  b21  u3  Kll  phi2  b!2  Ks21  etal  S14 

+  b21  u2  K13  phil  bl2  Ks22  eta2  S24  +  b21  u2  K13  phi2  bl2  Ks21  etal  S14 

+  b21  u3  Ksll  etal  Sll  bl2  Ks22  eta2  S24  +  b21  u2  Ksll  etal  S13  bl2  Ks22  eta2  S24 

+  b22  u2  K23 phil  bll  Ksl2  eta2  S24  +  b22  u2  K23 phi2  bll  Ksll  etal  S14 

+  b22  u3  Ks21  etal  Sll  bll  Ksl2  eta2  S24  +  b22  u2  Ks21  etal  S13  bl  1  Ksl2  eta2  S24 

+  b22  u3  Ks22  eta2  S2J  bll  Ksll  etal  S14  +  b22  u2  Ks22  eta2  S23  bll  Ksll  etal  S14 


+ 


Fd 


bll  u 


\ 


Ksll  etal  S14      Ksl2  eta2  S24 


phil 


+ 


phi2 


+  bl2  a 


2    Ks21  etal  S14      Ks22  eta2  S24 


J 


phil 


+  ■ 


phi2 


Determine    the    coefficients    CI    and   C2    such    that    zss=Cl*Fd+C2*Md 


>    Cl:=    simplify ( coeff ( collect  (expand ( zss ), Fd)  , Fd, 1 ))  ; 


CI 


2  phi22  phil  al3b22  Ks21  etal  SI 4  +  2  phi2  phil2  al3  b21  Ksl2  eta2  S24 


+  2  phi2  phil2  a!3  b22  Ks22  eta2  S24  +  2  phi22  phil  a!3  b21  Ksll  etal  S14 

+  plu2  phil2  bll  u3  Kll  b21  Ksl2  eta2  S24 +  2 phi2 phil2  bl  1  a3  Kl  1  b22  Ks22  eta2  S24 

+  phi2  phil  bll  u2  Ksll  etal  S13b21  Ksl2eta2S24 

+  2  phi2  phil  bll  u2  Ksll  etal  SI 3  b22  Ks22  eta2  S24 

+  2phi2  phil  bll  u3  Ksll  etal  Sll  b22  Ks22  eta2  S24 

+  2phi22  phil  bll  u2  K13b22Ks21  etal  S14  +  phi22  phil  bll  u2  K13b21  Ksll  etal  S14 

+  2phi2phil2  bll  u2  K13  b22  Ks22  eta2  S24  +  phi22  phil  bl  1  u3  Kll  b21  Ksll  etal  S14 

+  phi2  phil  bll  u3  Ksll  etal  Sll  b21  Ksl2  eta2  S24 

+  phi2  phil2  bll  u2  K13b21  Ksl2  eta2  S24  +  2  phi22  phil  bll  u3  Kll  b22  Ks21  etal  S14 

+  2phi2phil  bll  u3  Ksl2  eta2  S21  b22  Ks21  etal  S14 

+  phi2  phil  bll  i3  Ksl2  eta2  S21  b21  Ksll  etal  S14 

+  phi2  phil  bll  ii2  Ksl2  eta2  S23  b21  Ksll  etal  S14 

+  2  phi2  phil  bll  u2  Ksl2  eta2  S23  b22  Ks21  etal  S14 

+  2  phi2  phil2  b  12  u3  K21  b21  Ksl2  etal  S24 

+  2  phil  phil  bl2  u3  Ks21  etal  Sll  b21  Ksl2  eta2  S24 
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+  phi2  phil2  bll  u2  K13  b22  Ks22  etal  S24  +  2  phi2  phil1  bl2  u2  K23  b21  Ksl2  eta2  S24 

+  2phi22  phil  bl2  u3  K21  b21  Ksll  etal  S14  +  phi22  phil  bl2  u3  K21  b22  Ks21  etal  S14 

+  phi2  phil2  b  12  u3  K21  b22  Ks22  eta2  S24  +  2  phi22  phil  bl2  u2  K23  b21  Ksll  etal  S14 

+  phi22  phil  b!2  u2  K23  b22  Ks21  etal  S14 

+  phi2  phil  bl2  u2  Ks21  etal  SI 3  b22  Ks22  eta2  S24 

+  2  phi2  phil  bl2  u2  Ks21  etal  SI 3  b21  Ksl2  eta2  S24 

+  phi2  phil  bl2  u3  Ks21  etal  Sll  b22  Ks22  eta2  S24 

+  phi2  phil  b!2  u3  Ks22  eta2  S21  b22  Ks21  etal  S14 

+  2  phi2  phil  bl2  u3  Ks22  eta2  S21  b21  Ksll  etal  S14 

+  phi2  phil  b!2  u2  Ks22  eta2  S23  b22  Ks21  etal  S14 

+  2  phi2  phil  b!2  u2  Ks22  eta2  S23  b21  Ksll  etal  SI 4 

+  2phi2phil2  all  u2  b21  Ksl2  eta2  S24  +  2phi2phil2  all  u2  b22  Ks22  eta2  S24 

+  2phi22  phil  all  u2  b22  Ks21  etal  S14  +  2  phi22  phil  all  u2  b21  Ksll  etal  S14 

+  phi22  bll  u3  Ksll  etal2  Sll  b22  Ks21  S14+phi22  bll  u3  Ksll2  etal2  Sll  b21  S14 

+  phil2  bll  u2  Ksl22  eta22  S23  b21  S24+ phil2  bll  u2  Ksl2  eta22  S23  b22  Ks22  S24 

+  phi22  bll  u2  Ksll  etal2  S13  b22  Ks21  S14+phi22  bll  u2  Ksll2  etal2  S13  b21  S14 

+  phil2  bll  u3  Ksl22  eta22  S21  b21  S24  +  phil2  bll  u3  Ksl2  eta22  S21  b22  Ks22  S24 

+  phi22  b!2  u2  Ks212  etal2  SI 3  b22  S14+phi22  bl2  u2  Ks21  etal2  SI 3  b21  Ksll  S14 

+  phil2  b!2  u3  Ks22  eta22  S21  b21  Ksl2  S24  +  phil2  bl2  u3  Ks222  eta22  S21  b22  S24 

+  phi22  b!2  ii3  Ks212  etal2  Sll  b22  S14+phi22  bl2  u3  Ks21  etal2  Sll  b21  Ksll  S14 

+  phil2  bl2  i2  Ks22  eta22  S23  b21  Ksl2  S24  +  phil2  b!2  u2  Ks222  eta22  S23  b22  S24 

-  phi22  phil  all  u2  b!2  Ks21  etal  S14  -  phi2  phil2  a23  bll  Ksl2  eta2  S24 
-phi22  phil  a23  bll  Ksll  etal  S 14  -  phi2  phil2  a21  u2  bll  Ksl2  eta2  S24 
-phi22  phil  a21  u2  bll  Ksll  etal  S14  -  phi2  phil2  a21  u2  bl2  Ks22  eta2  S24 
-phi2  phil  b21  u3  Ksl2  eta2  S21  bl2  Ks21  etal  S14 

-  phi2  phil  b21  u2  Ksl2  eta2  S23  bl2  Ks21  etal  S14 

-plu2  phil2  b22  u3  K21  bll  Ksl2  eta2  S24  - phi22 phil  b22  u3  K21  bll  Ksll  etal  S14 

-  phi2  phil 2  a23  bl2  Ks22  eta2  S24  -  phi22  phil  a23  bl2  Ks21  etal  S14 

-phi2  phil2  b21  u3  Kll  bl2  Ks22  eta2  S24  -  phi22  phi  1  bll  u3  Kll  bll  Ksll  etal  S14 
-phil  phil2  bll  ii2  Kl  3  bll  Ksll  etal  S14  -  phil2  phil  bll  a2  Kl  3  bll  Ksll  etal  S14 
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-phil  phil  bll  u3  Ksll  etal  Sll  bll  Ksll  eta2  S24 

-  phi2  phil  bll  u2  Ksll  etal  SI 3  bl2  Ks22  eta2  S24 

-phi2ph.il1  b22u2  K23bll  Ksl2  eta2  S24  -  phi22  phil  b22  u2  K23  bll  Ksll  etal  S14 

-  phi2  phil  b22  u3  Ks21  etal  Sll  bll  Ksl2  eta2  S24 

-  phi2  phil  b22  u2  Ks21  etal  SI 3  bll  Ksl2  eta2  S24 

-  phi2  phil  b22  u3  Ks22  eta2  S21  bll  Ksll  etal  SI 4 

-phi2phil  b22  u2  Ks22  eta2  S23  bll  Ksll  etal  S14)l{u2  {phil  bll  Ksl2  eta2  S24 


+  pfu2  bll  Ksll  etal  S14+phil  bl2  Ks22  eta2  S24  +  phi2  bl2  Ks21  etal  SI 4) 
-bll  u3  Ksll  etal  Sll  b22  Ks22  eta2  S14-bll  u3  Kll  phil  b22  Ks22  eta2  S24 

-  bll  i3  Ksl2  eta2  S21  b22  Ks21  etal  S14-bll  it2  Ksl2  eta2  S23  b22  Ks21  etal  S14 

-  all  u2  phil  bll  Ksl2  eta2  S24  -  bll  u2  Ksll  etal  SI 3  b22  Ks22  eta2  S24 
-bll  u3  Kll  phi2  b22  Ks21  etal  S14  -bll  u2  K13  phil  b22  Ks22  eta2  S24 
-bll  u2  K13  phi2  b22  Ks21  etal  S14  -  a!3  phi2  bll  Ksll  etal  S 14 

-  all  u2  phi2  bll  Ksll  etal  S14  -  all  u2  phil  bll  Ks22  eta2  S24 

-  all  u2  phil  b22  Ks21  etal  S14  -  al3  phil  bll  Ksll  etal  S14 

-  bll  u2  K23phi2  bll  Ksll  etal  S14  -  al3  phil  bll  Ksll  etal  S14 

-  al3  phil  bll  Ksll  etal  S14  -  bll  u3  Kll  phil  bll  Ksll  etal  S14 

-  bll  u3  Kll  phil  bll  Ksll  etal  SU-bll  u2  K13  phil  bll  Ksll  etal  S14 
+  all  it2  phil  bll  Ksll  etal  S14  +  a!3  phil  bll  Ksll  etal  S14 

+  a!3  phil  bll  Ksll  etal  S14  -bll  a3  Ksll  etal  Sll  bll  Ksll  etal  S14 

-  bll  u2  Ksll  etal  SI 3  bll  Ksll  etal  S14  -  bll  u3  Ksll  etal  Sll  bll  Ksll  etal  S14 

-  bll  u2  Ksll  etal  S13  bll  Ksll  etal  S14  + all  u2  phil  bll  Ksll  etal  S14 
+  all  u2  phil  bll  Ksll  etal  S14  +  all  u2  phil  bll  Ksll  etal  S14 

+  bll  u3  Ksll  etal  Sll  bll  Ksll  etal  S14  +  bll  u2  Ksll  etal  S13  bll  Ksll  etal  S14 

+  bll  u3  Kll  phil  bll  Ksll  etal  S14  +  bll  u3  Kll  phil  bll  Ksll  etal  S14 
+  a!3  phil  bll  Ksll  etal  S14  +  a!3  phil  bll  Ksll  etal  S14 

+  bll  u3  Kll  phil  bll  Ksll  etal  S14  +  bll  u3  Kll  phil  bll  Ksll  etal  S14 

+  bll  u2  K13  phil  bll  Ksll  etal  S14  +  bll  u2  K13  phil  bll  Ksll  etal  S14 

+  b21  i3  Ksll  etal  Sll  bll  Ks22  eta2  S24  +  bll  u2  Ksll  etal  SI  3  bll  Ks22  eta2  S24 

+  bll  u2  K13  phil  bll  Ksll  etal  S14  +  bll  i2  K13  phil  bl  1  Ksll  etal  S14 


136 


+  b22  u3  Ks21  etal  Sll  bll  Ksl2  eta2  S24  +  b22  u2  Ks21  etal  SI  3  bll  Ksl2  eta2  S24 
+  b22  u3  Ks22  eta2  S21  bll  Ksll  etal  S14  +  b22  u2  Ks22  eta2  S23  bll  Ksll  etal  S14 

>    C2 : =  simplify (coeff (collect (expand ( zss) , Md) , Md, 1 )) ; 

C2  :=\Ksll  etal  phi2  bll  u3  Sll  +Ksll  etal phi2  bll  u2  S13  +  etal  phi2  u2  S13  b!2  Ks21 
+  etal  phi2  u3  Sll  b!2  Ks21  +  phi2  bl  1  phil  u3  Kll  +  phi2  bll  phil  u2  Kl 3  +  phi2  phil  al3 
+  phi2  phil  bl2  u2  K23  +  phi2  phil  all  it2  +  phi2  phil  b!2  u3  K21 
+  bll  phil  i3  Ksl2  eta2  S21  +  bl  1  phil  u2  Ksl2  eta2  S23  +  phil  b!2  u2  Ks22  eta2  S23 
+  phil  b!2  ii3  Ks22  eta2  S2l)/((-bll  u3  Ksll  etal  Sll  b22  Ks22  eta2  S24 

-  bll  u3  Kll  phil  b22  Ks22  eta2  S24  -  bll  u3  Ksl2  eta2  S21  b22  Ks21  etal  S14 

-  bll  u2  Ksl2  eta2  S23  b22  Ks21  etal  S14  -  all  u2  phil  b21  Ksl2  eta2  S24 

-  bll  u2  Ksll  etal  SI 3  b22  Ks22  eta2  S24  -  bll  u3  Kll  phi2  b22  Ks21  etal  S14 

-  bll  a2  KUphil  b22  Ks22  eta2  S24  -  bll  u2  K13  phi2  b22  Ks21  etal  S14 

-  al3phi2  b21  Ksll  etal  S14  -  all  u2  phi2  b21  Ksll  etal  S14 
-all  u2  phil  b22  Ks22  eta2  S24  -  all  u2  phi2  b22  Ks21  etal  SI  4 

-  al3phil  b21  Ksl2  eta2  S24  -  bl2  u2  K23  phi2  b21  Ksll  etal  S14 

-  a!3  phil  b22  Ks22  eta2  S24  -  a!3  phi2  b22  Ks21  etal  S14 

-  b!2  \?  K21  phil  b21  Ksl2  eta2  S24  -  b!2  u3  K21  phi2  b2 1  Ksll  etal  S14 

-  b!2  it2  K23  phil  b21  Ksl2  eta2  S24  +  a21  u2  phi2  b!2  Ks21  etal  SJ4 
+  a23phil  bll  Ksl2  eta2  S24  +  a23 phi2  bll  Ksll  etal  S14 

-  bl2  u3  Ks21  etal  Sll  b21  Ksl2  eta2  S24  -  b!2  u2  Ks21  etal  SI 3  b21  Ksl2  eta2  S24 

-  b!2  u3  Ks22  etal  S21  b21  Ksll  etal  S14  -  bl2  u2  Ks22  eta2  S23  b21  Ksll  etal  S14 
+  a21  u2  phil  bll  Ksl2  eta2  S24  +  a21  u2  phi2  bl  1  Ksll  etal  S14 

+  a21  u2  phil  bl2  Ks22  etal  S24  +  b21  u3  Ksl2  eta2  S21  bl2  Ks21  etal  S14 

+  b21  u2  Ksl2  etal  S23  bl2  Ks21  etal  S14  +  b22  u3  K21  phil  bll  Ksl2  eta2  S24 

+  b22  u3  K21  phi2  bll  Ksll  etal  S14  +  a23  phil  b!2  Ks22  eta2  S24 

+  a23  phi2  bll  Ks21  etal  S14  +  b21  u3  Kll  phil  bl2  Ks22  eta2  S24 

+  b21  i3  Kll  phi2  hi  2  Ks21  etal  S14  +  b21  u2  K13  phil  b!2  Ks22  eta2  S24 

+  b21  u2  K13  Phi2  b!2  Ks21  etal  S14  +  b21  it3  Ksll  etal  Sll  bl2  Ks22  eta2  S24 

+  b21  ii2  Ksll  etal  SI 3  bl2  Ks22  eta2  S24  +  b22  u2  K23  phil  bll  Ksl2  eta2  S24 

+  b22  u2  K23  phi2  bll  Ksll  etal  S14  +  b22  u3  Ks21  etal  Sll  bll  Ksl2eta2  S24 

+  b22  it2  Ks21  etal  SI 3  bll  Ksl2  eta2  S24  +  b22  u3  Ks22  eta2  S21  bll  Ksll  etal  S14 
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+  b22  u2  Ks22  eta2  S23  bll  Ksll  eta]  SI 4)  u2 


Check    that    zss=Cl*Fd+C2*Md 

>    eq6 :=simplify ( zss-Cl *Fd-C2 *Md)  ; 

eq6 

=  0 

> 
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